22 files changed, 3689 insertions, 18131 deletions

diff --git a/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/connectplus-prevent-oops-HACK.patch b/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/connectplus-prevent-oops-HACK.patch
new file mode 100644
index 0000000000..b5439c62e7
--- /dev/null
+++ b/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/connectplus-prevent-oops-HACK.patch
@@ -0,0 +1,17 @@
+Index: linux-2.6.21/drivers/net/wireless/hostap/hostap_hw.c
+===================================================================
+--- linux-2.6.21.orig/drivers/net/wireless/hostap/hostap_hw.c   2007-07-07 12:45:39.000000000 +0100
++++ linux-2.6.21/drivers/net/wireless/hostap/hostap_hw.c        2007-07-07 12:47:30.000000000 +0100
+@@ -2666,6 +2666,12 @@
+        iface = netdev_priv(dev);
+        local = iface->local;
+ 
++       if(dev->base_addr == 0)
++       {
++               printk(KERN_DEBUG "%s: IRQ before base_addr set\n", dev->name);
++               return IRQ_HANDLED;
++       }
++
+        prism2_io_debug_add(dev, PRISM2_IO_DEBUG_CMD_INTERRUPT, 0, 0);
+ 
+        if (local->func->card_present && !local->func->card_present(local)) {
diff --git a/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/hx2750_base-r31.patch b/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/hx2750_base-r31.patch
deleted file mode 100644
index 5d58bcf55d..0000000000
--- a/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/hx2750_base-r31.patch
+++ /dev/null
@@ -1,1094 +0,0 @@
----
- arch/arm/mach-pxa/Kconfig         |   10 
- arch/arm/mach-pxa/Makefile        |    1 
- arch/arm/mach-pxa/hx2750.c        |  450 ++++++++++++++++++++++++++++++++++++++
- arch/arm/mach-pxa/hx2750_test.c   |  433 ++++++++++++++++++++++++++++++++++++
- arch/arm/mach-pxa/pm.c            |    5 
- arch/arm/mach-pxa/pxa25x.c        |    4 
- arch/arm/mach-pxa/pxa27x.c        |    4 
- include/asm-arm/arch-pxa/hx2750.h |   90 +++++++
- 8 files changed, 995 insertions(+), 2 deletions(-)
-
---- /dev/null
-+++ linux-2.6.24-rc1/include/asm-arm/arch-pxa/hx2750.h
-@@ -0,0 +1,90 @@
-+/*
-+ * Hardware specific definitions for iPAQ hx2750
-+ *
-+ * Copyright 2005 Openedhand Ltd.
-+ *
-+ * Author: Richard Purdie <richard@o-hand.com>
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ */
-+#ifndef __ASM_ARCH_HX2750_H
-+#define __ASM_ARCH_HX2750_H  1
-+
-+/*
-+ * HX2750 (Non Standard) GPIO Definitions
-+ */
-+
-+#define HX2750_GPIO_KEYPWR      (0)    /* Power button */
-+#define HX2750_GPIO_BATTCOVER1  (9)    /* Battery Cover Switch */
-+#define HX2750_GPIO_CF_IRQ      (11)   /* CF IRQ? */
-+#define HX2750_GPIO_USBCONNECT  (12)   /* USB Connected? */
-+#define HX2750_GPIO_CF_DETECT   (13)   /* CF Card Detect? */
-+#define HX2750_GPIO_EXTPWR      (14)   /* External Power Detect */
-+#define HX2750_GPIO_BATLVL      (15)   /* Battery Level Detect */
-+#define HX2750_GPIO_CF_PWR      (17)   /* CF Power? */
-+#define HX2750_GPIO_SR_STROBE   (18)   /* Shift Register Strobe */
-+#define HX2750_GPIO_CHARGE      (22)   /* Charging Enable (active low) */
-+#define HX2750_GPIO_TSC2101_SS  (24)   /* TSC2101 SS# */
-+#define HX2750_GPIO_BTPWR       (27)   /* Bluetooth Power? */
-+#define HX2750_GPIO_BATTCOVER2  (33)   /* Battery Cover Switch */
-+#define HX2750_GPIO_SD_DETECT   (38)   /* MMC Card Detect */
-+#define HX2750_GPIO_SR_CLK1     (52)   /* Shift Register Clock */
-+#define HX2750_GPIO_SR_CLK2     (53)
-+#define HX2750_GPIO_CF_WIFIIRQ  (54)   /* CF Wifi IRQ? */
-+#define HX2750_GPIO_GPIO_DIN    (88)   /* Shift Register Data */
-+#define HX2750_GPIO_KEYLEFT     (90)   /* Left button */
-+#define HX2750_GPIO_KEYRIGHT    (91)   /* Right button */
-+#define HX2750_GPIO_KEYCAL      (93)   /* Calander button */
-+#define HX2750_GPIO_KEYTASK     (94)   /* Task button */
-+#define HX2750_GPIO_KEYSIDE     (95)   /* Side button */
-+#define HX2750_GPIO_KEYENTER    (96)   /* Enter Button*/
-+#define HX2750_GPIO_KEYCON      (97)   /* Contacts button */
-+#define HX2750_GPIO_KEYMAIL     (98)   /* Mail button */
-+#define HX2750_GPIO_BIOPWR      (99)   /* BIO Reader Power? */
-+#define HX2750_GPIO_KEYUP       (100)  /* Up button */
-+#define HX2750_GPIO_KEYDOWN     (101)  /* Down button*/
-+#define HX2750_GPIO_SD_READONLY (103)  /* MMC/SD Write Protection */
-+#define HX2750_GPIO_LEDMAIL     (106)  /* Green Mail LED */
-+#define HX2750_GPIO_HP_JACK     (108)  /* Head Phone Jack Present */
-+#define HX2750_GPIO_PENDOWN     (117)  /* Touch Screen Pendown */
-+
-+
-+//#define HX2750_GPIO_     () /* */
-+
-+/*
-+ * HX2750 Interrupts
-+ */
-+#define HX2750_IRQ_GPIO_EXTPWR      IRQ_GPIO(HX2750_GPIO_EXTPWR)
-+#define HX2750_IRQ_GPIO_SD_DETECT   IRQ_GPIO(HX2750_GPIO_SD_DETECT)
-+#define HX2750_IRQ_GPIO_PENDOWN     IRQ_GPIO(HX2750_GPIO_PENDOWN)
-+#define HX2750_IRQ_GPIO_CF_DETECT   IRQ_GPIO(HX2750_GPIO_CF_DETECT)
-+#define HX2750_IRQ_GPIO_CF_IRQ      IRQ_GPIO(HX2750_GPIO_CF_IRQ)
-+#define HX2750_IRQ_GPIO_CF_WIFIIRQ  IRQ_GPIO(HX2750_GPIO_CF_WIFIIRQ)
-+
-+/*
-+ * HX2750 Extra GPIO Definitions
-+ */
-+
-+#define HX2750_EGPIO_WIFI_PWR  (1 << 11)  /* Wifi power */
-+#define HX2750_EGPIO_LCD_PWR   (1 << 10)  /* LCD Power */
-+#define HX2750_EGPIO_BL_PWR     (1 << 9)   /* Backlight LED Power */
-+#define HX2750_EGPIO_8          (1 << 8)   /* */
-+#define HX2750_EGPIO_7          (1 << 7)   /* */
-+#define HX2750_EGPIO_SD_PWR     (1 << 6)   /* SD Power */
-+#define HX2750_EGPIO_TSC_PWR    (1 << 5)   /* TS Power */
-+#define HX2750_EGPIO_CF0_RESET  (1 << 4)   /* CF0 Reset */
-+#define HX2750_EGPIO_CF1_RESET  (1 << 3)   /* CF1 Reset */
-+#define HX2750_EGPIO_2          (1 << 2)   /* Power/Red LED Related?*/
-+#define HX2750_EGPIO_1          (1 << 1)   /* Power/Red LED Related?*/
-+#define HX2750_EGPIO_PWRLED     (1 << 0)   /* Power/Red LED Related?*/
-+
-+
-+void hx2750_set_egpio(unsigned int gpio);
-+void hx2750_clear_egpio(unsigned int gpio);
-+
-+
-+#endif /* __ASM_ARCH_HX2750_H  */
-+
---- linux-2.6.24-rc1.orig/arch/arm/mach-pxa/Makefile
-+++ linux-2.6.24-rc1/arch/arm/mach-pxa/Makefile
-@@ -22,6 +22,7 @@
- obj-$(CONFIG_MACH_POODLE)      += poodle.o corgi_ssp.o
- obj-$(CONFIG_MACH_TOSA)                += tosa.o
- obj-$(CONFIG_MACH_EM_X270)     += em-x270.o
-+obj-$(CONFIG_MACH_HX2750)      += hx2750.o hx2750_test.o
- 
- ifeq ($(CONFIG_MACH_ZYLONITE),y)
-   obj-y                                += zylonite.o
---- /dev/null
-+++ linux-2.6.24-rc1/arch/arm/mach-pxa/hx2750_test.c
-@@ -0,0 +1,433 @@
-+/*
-+ * HP iPAQ hx2750 Test Development Code
-+ *
-+ * Copyright 2005 Openedhand Ltd.
-+ *
-+ * Author: Richard Purdie <richard@o-hand.com>
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ */
-+
-+#include <linux/init.h>
-+#include <linux/kernel.h>
-+#include <linux/ioport.h>
-+#include <linux/device.h>
-+#include <linux/input.h>
-+#include <linux/delay.h>
-+#include <linux/interrupt.h>
-+
-+#include <asm/mach-types.h>
-+#include <asm/hardware.h>
-+#include <asm/mach/arch.h>
-+
-+#include <asm/arch/hx2750.h>
-+#include <asm/arch/pxa-regs.h>
-+
-+
-+static int prodval;
-+
-+/*
-+ * Sysfs functions
-+ */
-+static ssize_t test1_show(struct device *dev, char *buf)
-+{
-+       unsigned long rp;
-+
-+       asm ("mrc       p15, 0, %0, cr1, cr0;\n" :"=r"(rp) );
-+       printk("%lx\n",rp);
-+
-+       asm ("mrc       p15, 0, %0, cr1, cr1;\n" :"=r"(rp) );
-+       printk("%lx\n",rp);
-+
-+       asm ("mrc       p15, 0, %0, cr2, cr0;\n" :"=r"(rp) );
-+       printk("%lx\n",rp);
-+
-+       asm ("mrc       p15, 0, %0, cr3, cr0;\n" :"=r"(rp) );
-+       printk("%lx\n",rp);
-+
-+       asm ("mrc       p15, 0, %0, cr13, cr0;\n" :"=r"(rp) );
-+       printk("%lx\n",rp);
-+
-+       return sprintf(buf, "%d\n",prodval);
-+}
-+extern void tsc2101_print_miscdata(struct device *dev);
-+extern struct platform_device tsc2101_device;
-+
-+static ssize_t test1_store(struct device *dev, const char *buf, size_t count)
-+{
-+       prodval = simple_strtoul(buf, NULL, 10);
-+
-+       tsc2101_print_miscdata(&tsc2101_device.dev);
-+
-+       return count;
-+}
-+
-+static DEVICE_ATTR(test1, 0644, test1_show, test1_store);
-+
-+static ssize_t test2_show(struct device *dev, char *buf)
-+{
-+       printk(KERN_ERR "SSCR0_P2: %08x\n", SSCR0_P2);
-+       printk(KERN_ERR "SSCR1_P2: %08x\n", SSCR1_P2);
-+       printk(KERN_ERR "SSSR_P2:  %08x\n", SSSR_P2);
-+       printk(KERN_ERR "SSITR_P2: %08x\n", SSITR_P2);
-+       printk(KERN_ERR "SSDR_P2:  %08x\n", SSDR_P2);
-+       printk(KERN_ERR "SSTO_P2:  %08x\n", SSTO_P2);
-+       printk(KERN_ERR "SSPSP_P2: %08x\n", SSPSP_P2);
-+
-+       hx2750_ssp_init2();
-+
-+       printk(KERN_ERR "SSCR0_P2: %08x\n", SSCR0_P2);
-+       printk(KERN_ERR "SSCR1_P2: %08x\n", SSCR1_P2);
-+       printk(KERN_ERR "SSSR_P2:  %08x\n", SSSR_P2);
-+       printk(KERN_ERR "SSITR_P2: %08x\n", SSITR_P2);
-+       printk(KERN_ERR "SSDR_P2:  %08x\n", SSDR_P2);
-+       printk(KERN_ERR "SSTO_P2:  %08x\n", SSTO_P2);
-+       printk(KERN_ERR "SSPSP_P2: %08x\n", SSPSP_P2);
-+
-+       return sprintf(buf, "%d\n",0);
-+}
-+
-+static DEVICE_ATTR(test2, 0444, test2_show, NULL);
-+
-+extern unsigned int hx2750_egpio_current;
-+
-+static ssize_t setegpio_show(struct device *dev, char *buf)
-+{
-+       return sprintf(buf, "%x\n",hx2750_egpio_current);
-+}
-+
-+static ssize_t setegpio_store(struct device *dev, const char *buf, size_t count)
-+{
-+       unsigned int val = simple_strtoul(buf, NULL, 10);
-+
-+       hx2750_set_egpio(1 << val);
-+
-+       return count;
-+}
-+
-+static DEVICE_ATTR(setegpio, 0644, setegpio_show, setegpio_store);
-+
-+static ssize_t clregpio_show(struct device *dev, char *buf)
-+{
-+       return sprintf(buf, "%x\n",hx2750_egpio_current);
-+}
-+
-+static ssize_t gpio_show(struct device *dev, char *buf)
-+{
-+       int i;
-+
-+       printk(KERN_ERR "GPIO# D S A INTER\n");
-+
-+       for (i=0;i<119;i++) {
-+               printk(KERN_ERR " %3d: ",i);
-+               if (GPDR(i) & GPIO_bit(i))
-+                       printk("O ");
-+               else
-+                       printk("I ");
-+               printk("%d ",(GPLR(i) & GPIO_bit(i)) != 0);
-+               printk("%d ",((GAFR(i) & (0x3 << (((i) & 0xf)*2)))) >> (((i) & 0xf)*2) );
-+               if (GEDR(i) & GPIO_bit(i))
-+                       printk("ED ");
-+               if (GRER(i) & GPIO_bit(i))
-+                       printk("RE ");
-+               if (GFER(i) & GPIO_bit(i))
-+                       printk("FE ");
-+
-+               printk("\n");
-+       }
-+       return sprintf(buf, "EGPIO: %x\n",hx2750_egpio_current);
-+}
-+
-+static ssize_t clregpio_store(struct device *dev, const char *buf, size_t count)
-+{
-+       unsigned int val = simple_strtoul(buf, NULL, 10);
-+
-+       hx2750_clear_egpio(1 << val);
-+
-+       return count;
-+}
-+
-+static DEVICE_ATTR(clregpio, 0644, clregpio_show, clregpio_store);
-+
-+
-+static ssize_t gpioclr_store(struct device *dev, const char *buf, size_t count)
-+{
-+       int prod;
-+       prod = simple_strtoul(buf, NULL, 10);
-+
-+       GPCR(prod) = GPIO_bit(prod);
-+
-+       return count;
-+}
-+
-+static DEVICE_ATTR(gpioclr, 0644, gpio_show, gpioclr_store);
-+
-+static ssize_t gpioset_store(struct device *dev, const char *buf, size_t count)
-+{
-+       int prod;
-+       prod = simple_strtoul(buf, NULL, 10);
-+
-+       GPSR(prod) = GPIO_bit(prod);
-+
-+       return count;
-+}
-+
-+static DEVICE_ATTR(gpioset, 0644, gpio_show, gpioset_store);
-+
-+
-+static ssize_t ssp2read_store(struct device *dev, const char *buf, size_t count)
-+{
-+       unsigned int val = simple_strtoul(buf, NULL, 16);
-+
-+       printk("Read: %08x\n",hx2750_ssp2_read(val));
-+
-+       return count;
-+}
-+
-+static DEVICE_ATTR(ssp2read, 0200, NULL, ssp2read_store);

-+

-+static ssize_t ssp2write_store(struct device *dev, const char *buf, size_t count)
-+{
-+       unsigned int val = simple_strtoul(buf, NULL, 16);
-+
-+       printk("Write: %08x\n",hx2750_ssp2_write(val));
-+
-+       return count;
-+}
-+
-+static DEVICE_ATTR(ssp2write, 0200, NULL, ssp2write_store);
-+
-+
-+static ssize_t sspr_store(struct device *dev, const char *buf, size_t count)
-+{
-+       unsigned long val,ret;
-+       val = simple_strtoul(buf, NULL, 0);
-+
-+       hx2750_tsc2101_send(1<<15,val,&ret,1);
-+
-+       printk("Response: %x\n",ret);
-+
-+       return count;
-+}
-+
-+static DEVICE_ATTR(sspr, 0200, NULL, sspr_store);
-+
-+static ssize_t sspw_store(struct device *dev, const char *buf, size_t count)
-+{
-+       int val,ret;
-+       sscanf(buf, "%lx %lx", &val, &ret);
-+
-+       hx2750_tsc2101_send(0,val,&ret,1);
-+
-+       return count;
-+}
-+
-+static DEVICE_ATTR(sspw, 0200, NULL, sspw_store);
-+
-+
-+extern struct pm_ops pxa_pm_ops;
-+extern void pxa_cpu_resume(void);
-+extern unsigned long pxa_pm_pspr_value;
-+
-+static int (*pxa_pm_enter_orig)(suspend_state_t state);
-+
-+//static struct {
-+//     u32 ffier, fflcr, ffmcr, ffspr, ffisr, ffdll, ffdlh;
-+//} sys_ctx;
-+
-+u32 resstruct[20];
-+
-+static int hx2750_pxa_pm_enter(suspend_state_t state)
-+{
-+       int i;
-+       u32 save[10];
-+
-+       PWER = 0xC0000003;// | PWER_RTC;
-+       PFER = 0x00000003;
-+       PRER = 0x00000003;
-+
-+       PGSR0=0x00000018;
-+       PGSR1=0x00000380;
-+       PGSR2=0x00800000;
-+       PGSR3=0x00500400;
-+
-+       //PVCR=0x494; or 0x14;
-+       //PVCR=0x14;
-+       //PCMD0=0x41f;
-+       //i=PISR;
-+       //PICR=0x00000062;
-+
-+       //PCFR=0x457;
-+       //PCFR=0x70; // Does not resume from sleep
-+       PCFR=0x077; // was 0x477
-+       PSLR=0xff100004;
-+
-+       resstruct[0]=0x0000b4e6;
-+       resstruct[1]=0x00000001;
-+       resstruct[2]=virt_to_phys(pxa_cpu_resume);
-+       resstruct[3]=0xffffffff; //value for r0
-+
-+       resstruct[14]=0x00000078;  //mcr        15, 0, r0, cr1, cr0, {0}
-+       resstruct[15]=0x00000000;  //mcr        15, 0, r0, cr1, cr1, {0} 0xffffffff

-+       resstruct[16]=0xa0000000;  //mcr        15, 0, r0, cr2, cr0, {0} 0xa0748000

-+       resstruct[17]=0x00000001;  //mcr        15, 0, r0, cr3, cr0, {0} 0x00000015

-+       resstruct[18]=0x00000000;  //mcr        15, 0, r0, cr13, cr0, {0} 0x00000000

-+
-+       pxa_pm_pspr_value=virt_to_phys(&resstruct[0]);
-+
-+       hx2750_send_egpio(3);
-+
-+       pxa_gpio_mode(87 | GPIO_OUT  | GPIO_DFLT_HIGH);
-+
-+       //sys_ctx.ffier = FFIER;
-+       //sys_ctx.fflcr = FFLCR;
-+       //sys_ctx.ffmcr = FFMCR;
-+       //sys_ctx.ffspr = FFSPR;
-+       //sys_ctx.ffisr = FFISR;
-+       //FFLCR |= 0x80;
-+       //sys_ctx.ffdll = FFDLL;
-+       //sys_ctx.ffdlh = FFDLH;
-+       //FFLCR &= 0xef;
-+
-+       pxa_pm_enter_orig(state);
-+
-+       //FFMCR = sys_ctx.ffmcr;
-+       //FFSPR = sys_ctx.ffspr;
-+       //FFLCR = sys_ctx.fflcr;
-+       //FFLCR |= 0x80;
-+       //FFDLH = sys_ctx.ffdlh;
-+       //FFDLL = sys_ctx.ffdll;
-+       //FFLCR = sys_ctx.fflcr;
-+       //FFISR = sys_ctx.ffisr;
-+       //FFLCR = 0x07;
-+       //FFIER = sys_ctx.ffier;
-+
-+       return 0;
-+}
-+
-+static irqreturn_t hx2750_charge_int(int irq, void *dev_id, struct pt_regs *regs)
-+{
-+       if ((GPLR(HX2750_GPIO_EXTPWR) & GPIO_bit(HX2750_GPIO_EXTPWR)) == 0) {
-+               printk("Charging On\n");
-+               GPCR(HX2750_GPIO_CHARGE);
-+       } else {
-+               printk("Charging Off\n");
-+               GPSR(HX2750_GPIO_CHARGE);
-+       }
-+
-+       return IRQ_HANDLED;
-+}
-+
-+
-+
-+
-+static irqreturn_t hx2750_interrupt(int irq, void *dev_id, struct pt_regs *regs)
-+{
-+    printk("Input %d changed.\n", irq-32);
-+
-+       return IRQ_HANDLED;
-+}
-+
-+
-+static int __init hx2750_test_probe(struct device *dev)
-+{
-+       pxa_gpio_mode(21 | GPIO_OUT | GPIO_DFLT_HIGH);
-+       pxa_gpio_mode(HX2750_GPIO_CHARGE | GPIO_OUT | GPIO_DFLT_HIGH);
-+       pxa_gpio_mode(83 | GPIO_OUT | GPIO_DFLT_HIGH);
-+       pxa_gpio_mode(HX2750_GPIO_BIOPWR | GPIO_OUT | GPIO_DFLT_HIGH);
-+       pxa_gpio_mode(116 | GPIO_OUT | GPIO_DFLT_HIGH);
-+       pxa_gpio_mode(118 | GPIO_OUT | GPIO_DFLT_HIGH);
-+
-+
-+       //pxa_gpio_mode(HX2750_GPIO_CF_PWR | GPIO_OUT | GPIO_DFLT_LOW);
-+       pxa_gpio_mode(HX2750_GPIO_CF_PWR | GPIO_OUT | GPIO_DFLT_HIGH);
-+       pxa_gpio_mode(HX2750_GPIO_BTPWR | GPIO_OUT | GPIO_DFLT_LOW);
-+       pxa_gpio_mode(79 | GPIO_OUT | GPIO_DFLT_LOW);
-+       pxa_gpio_mode(85 | GPIO_OUT | GPIO_DFLT_LOW);
-+       pxa_gpio_mode(HX2750_GPIO_LEDMAIL | GPIO_OUT | GPIO_DFLT_LOW);
-+       pxa_gpio_mode(107 | GPIO_OUT | GPIO_DFLT_LOW);
-+       pxa_gpio_mode(114 | GPIO_OUT | GPIO_DFLT_LOW);
-+
-+       pxa_gpio_mode(HX2750_GPIO_BATTCOVER1 | GPIO_IN);
-+       pxa_gpio_mode(HX2750_GPIO_BATTCOVER2 | GPIO_IN);
-+       pxa_gpio_mode(HX2750_GPIO_CF_IRQ | GPIO_IN);
-+       pxa_gpio_mode(HX2750_GPIO_USBCONNECT | GPIO_IN);
-+       pxa_gpio_mode(HX2750_GPIO_CF_DETECT | GPIO_IN);
-+       pxa_gpio_mode(HX2750_GPIO_EXTPWR | GPIO_IN);
-+
-+       pxa_gpio_mode(HX2750_GPIO_BATLVL | GPIO_IN);
-+       //pxa_gpio_mode(HX2750_GPIO_CF_WIFIIRQ | GPIO_IN);
-+       pxa_gpio_mode(80 | GPIO_IN);
-+       pxa_gpio_mode(HX2750_GPIO_HP_JACK | GPIO_IN);
-+       pxa_gpio_mode(115 | GPIO_IN);
-+       pxa_gpio_mode(119 | GPIO_IN);
-+
-+       request_irq(IRQ_GPIO(HX2750_GPIO_BATLVL), hx2750_interrupt, SA_INTERRUPT, "hx2750test", NULL);
-+       //request_irq(IRQ_GPIO(HX2750_GPIO_CF_WIFIIRQ), hx2750_interrupt, SA_INTERRUPT, "hx2750test", NULL);
-+       request_irq(IRQ_GPIO(80), hx2750_interrupt, SA_INTERRUPT, "hx2750test", NULL);
-+       request_irq(IRQ_GPIO(115), hx2750_interrupt, SA_INTERRUPT, "hx2750test", NULL);
-+       request_irq(IRQ_GPIO(119), hx2750_interrupt, SA_INTERRUPT, "hx2750test", NULL);
-+       request_irq(IRQ_GPIO(HX2750_GPIO_SR_CLK2), hx2750_interrupt, SA_INTERRUPT, "hx2750test", NULL);
-+
-+       //request_irq(IRQ_GPIO(10), hx2750_interrupt, SA_INTERRUPT, "hx2750test", NULL);
-+
-+       set_irq_type(IRQ_GPIO(HX2750_GPIO_BATLVL),IRQT_BOTHEDGE);
-+       //set_irq_type(IRQ_GPIO(HX2750_GPIO_CF_WIFIIRQ),IRQT_BOTHEDGE);
-+       set_irq_type(IRQ_GPIO(80),IRQT_BOTHEDGE);
-+       set_irq_type(IRQ_GPIO(115),IRQT_BOTHEDGE);
-+       set_irq_type(IRQ_GPIO(119),IRQT_BOTHEDGE);
-+       set_irq_type(IRQ_GPIO(HX2750_GPIO_SR_CLK2),IRQT_BOTHEDGE);
-+
-+       //set_irq_type(IRQ_GPIO(10),IRQT_BOTHEDGE);
-+
-+       printk("hx2750 Test Code Initialized.\n");
-+       device_create_file(dev, &dev_attr_test1);
-+       device_create_file(dev, &dev_attr_test2);
-+       device_create_file(dev, &dev_attr_setegpio);
-+       device_create_file(dev, &dev_attr_clregpio);
-+       device_create_file(dev, &dev_attr_gpioset);
-+       device_create_file(dev, &dev_attr_gpioclr);
-+       device_create_file(dev, &dev_attr_sspr);
-+       device_create_file(dev, &dev_attr_sspw);
-+       device_create_file(dev, &dev_attr_ssp2read);
-+       device_create_file(dev, &dev_attr_ssp2write);
-+
-+       request_irq(HX2750_IRQ_GPIO_EXTPWR, hx2750_charge_int, SA_INTERRUPT, "hx2750_extpwr", NULL);
-+       set_irq_type(HX2750_IRQ_GPIO_EXTPWR, IRQT_BOTHEDGE);
-+
-+       pxa_pm_enter_orig=pxa_pm_ops.enter;
-+       pxa_pm_ops.enter=hx2750_pxa_pm_enter;
-+
-+       return 0;
-+}
-+
-+static struct device_driver hx2750_test_driver = {
-+       .name           = "hx2750-test",
-+       .bus            = &platform_bus_type,
-+       .probe          = hx2750_test_probe,
-+//     .remove         = hx2750_bl_remove,
-+//     .suspend        = hx2750_bl_suspend,
-+//     .resume         = hx2750_bl_resume,
-+};
-+
-+
-+static int __init hx2750_test_init(void)
-+{
-+       return driver_register(&hx2750_test_driver);
-+}
-+
-+
-+static void __exit hx2750_test_exit(void)
-+{
-+       driver_unregister(&hx2750_test_driver);
-+}
-+
-+module_init(hx2750_test_init);
-+module_exit(hx2750_test_exit);
-+
-+MODULE_AUTHOR("Richard Purdie <richard@o-hand.com>");
-+MODULE_DESCRIPTION("iPAQ hx2750 Backlight Driver");
-+MODULE_LICENSE("GPLv2");
---- linux-2.6.24-rc1.orig/arch/arm/mach-pxa/Kconfig
-+++ linux-2.6.24-rc1/arch/arm/mach-pxa/Kconfig
-@@ -83,6 +83,15 @@
-        bool "Sharp PXA270 models (SL-Cxx00)"
-        select PXA27x
- 
-+config MACH_HX2750
-+       bool "HP iPAQ hx2750"
-+       select PXA27x
-+       select PXA_KEYS
-+       select MFD_TSC2101
-+       select PXA_SSP
-+       help
-+         This enables support for the HP iPAQ HX2750 handheld.
-+
- endchoice
- 
- endif
-@@ -181,3 +190,4 @@
-        help
-          Enable support for PXA2xx SSP ports
- endif
-+
---- /dev/null
-+++ linux-2.6.24-rc1/arch/arm/mach-pxa/hx2750.c
-@@ -0,0 +1,450 @@
-+/*
-+ * Machine definitions for HP iPAQ hx2750
-+ *
-+ * Copyright 2005 Openedhand Ltd.
-+ *
-+ * Author: Richard Purdie <richard@o-hand.com>
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ */
-+
-+
-+#include <linux/init.h>
-+#include <linux/kernel.h>
-+#include <linux/ioport.h>
-+#include <linux/platform_device.h>
-+#include <linux/delay.h>
-+#include <linux/input.h>
-+#include <linux/irq.h>
-+#include <linux/mmc/host.h>
-+#include <linux/mfd/tsc2101.h>
-+
-+#include <asm/mach-types.h>
-+#include <asm/hardware.h>
-+#include <asm/mach/arch.h>
-+
-+#include <asm/arch/hx2750.h>
-+#include <asm/arch/pxa-regs.h>
-+#include <asm/arch/pxa_keys.h>
-+#include <asm/mach/map.h>
-+#include <asm/arch/udc.h>
-+#include <asm/arch/mmc.h>
-+#include <asm/arch/audio.h>
-+#include <asm/arch/pxafb.h>
-+#include <asm/arch/ssp.h>
-+
-+#include "generic.h"
-+
-+
-+/*
-+ * Keys Support
-+ */
-+static struct pxa_keys_button hx2750_button_table[] = {
-+       { KEY_POWER, HX2750_GPIO_KEYPWR, PXAKEY_PWR_KEY },
-+       { KEY_LEFT, HX2750_GPIO_KEYLEFT, 0 },
-+       { KEY_RIGHT, HX2750_GPIO_KEYRIGHT, 0 },
-+       { KEY_KP0, HX2750_GPIO_KEYCAL, 0 },
-+       { KEY_KP1, HX2750_GPIO_KEYTASK, 0 },
-+       { KEY_KP2, HX2750_GPIO_KEYSIDE, 0 },
-+       { KEY_ENTER, HX2750_GPIO_KEYENTER, 0 },
-+       { KEY_KP3, HX2750_GPIO_KEYCON, 0 }, //KEY_CONTACTS
-+       { KEY_MAIL, HX2750_GPIO_KEYMAIL, 0 },
-+       { KEY_UP, HX2750_GPIO_KEYUP, 0 },
-+       { KEY_DOWN, HX2750_GPIO_KEYDOWN, 0 },
-+};
-+
-+static struct pxa_keys_platform_data hx2750_pxa_keys_data = {
-+       .buttons = hx2750_button_table,
-+       .nbuttons = ARRAY_SIZE(hx2750_button_table),
-+};
-+
-+static struct platform_device hx2750_pxa_keys = {
-+       .name = "pxa2xx-keys",
-+       .dev = {
-+               .platform_data = &hx2750_pxa_keys_data,
-+       },
-+};
-+
-+
-+/*
-+ * Backlight Device
-+ */
-+extern struct platform_device pxafb_device;
-+
-+static struct platform_device hx2750_bl_device = {
-+       .name           = "hx2750-bl",
-+       .id             = -1,
-+//     .dev    = {
-+//             .parent = &pxafb_device.dev,
-+//     }
-+};
-+
-+
-+/*
-+ * UDC/USB
-+ */
-+static int hx2750_udc_is_connected (void)
-+{
-+       return GPLR0 & GPIO_bit(HX2750_GPIO_USBCONNECT);
-+}
-+
-+//static void hx2750_udc_command (int cmd)
-+//{
-+//}
-+
-+static struct pxa2xx_udc_mach_info hx2750_udc_mach_info = {
-+       .udc_is_connected = hx2750_udc_is_connected,
-+//     .udc_command      = hx2750_udc_command,
-+};
-+
-+
-+/*
-+ * SSP Devices Setup
-+ */
-+static struct ssp_dev hx2750_ssp_dev1;
-+static struct ssp_dev hx2750_ssp_dev2;
-+static struct ssp_dev hx2750_ssp_dev3;
-+
-+void hx2750_ssp_init(void)
-+{
-+       pxa_gpio_mode(HX2750_GPIO_TSC2101_SS | GPIO_OUT | GPIO_DFLT_HIGH);
-+
-+       if (ssp_init(&hx2750_ssp_dev1, 1, 0))
-+               printk(KERN_ERR "Unable to register SSP1 handler!\n");
-+       else {
-+               ssp_disable(&hx2750_ssp_dev1);
-+               ssp_config(&hx2750_ssp_dev1, (SSCR0_Motorola | (SSCR0_DSS & 0x0f )), SSCR1_SPH, 0, SSCR0_SerClkDiv(6));
-+               ssp_enable(&hx2750_ssp_dev1);
-+               hx2750_set_egpio(HX2750_EGPIO_TSC_PWR);
-+       }
-+
-+//     if (ssp_init(&hx2750_ssp_dev2, 2, 0))
-+//             printk(KERN_ERR "Unable to register SSP2 handler!\n");
-+//     else {
-+//             ssp_disable(&hx2750_ssp_dev2);
-+//             ssp_config(&hx2750_ssp_dev2, (SSCR0_TI | (SSCR0_DSS & 0x09 )), 0, 0, SSCR0_SerClkDiv(140));
-+//             ssp_enable(&hx2750_ssp_dev2);
-+//     }
-+//
-+       if (ssp_init(&hx2750_ssp_dev3, 3, 0))
-+               printk(KERN_ERR "Unable to register SSP3 handler!\n");
-+       else {
-+               ssp_disable(&hx2750_ssp_dev3);
-+               ssp_config(&hx2750_ssp_dev3, (SSCR0_Motorola | (SSCR0_DSS & 0x07 )), SSCR1_SPO | SSCR1_SPH, 0, SSCR0_SerClkDiv(166));
-+               ssp_enable(&hx2750_ssp_dev3);
-+       }
-+
-+       printk("SSP Devices Initialised\n");
-+
-+       return;
-+}
-+
-+struct ssp_state ssp1;
-+
-+void hx2750_ssp_suspend(void)
-+{
-+       ssp_disable(&hx2750_ssp_dev1);
-+       ssp_save_state(&hx2750_ssp_dev1,&ssp1);
-+       hx2750_clear_egpio(HX2750_EGPIO_TSC_PWR);
-+}
-+
-+void hx2750_ssp_resume(void)
-+{
-+       hx2750_set_egpio(HX2750_EGPIO_TSC_PWR);
-+       ssp_restore_state(&hx2750_ssp_dev1,&ssp1);
-+       ssp_enable(&hx2750_ssp_dev1);
-+}
-+
-+void hx2750_ssp_init2(void)
-+{
-+       printk("Stage 1: %x\n",CKEN);
-+       if (ssp_init(&hx2750_ssp_dev2, 2, 0))
-+               printk(KERN_ERR "Unable to register SSP2 handler!\n");
-+       else {
-+               printk("Stage 2: %x\n",CKEN);
-+               ssp_disable(&hx2750_ssp_dev2);
-+               printk("Stage 3: %x\n",CKEN);
-+               ssp_config(&hx2750_ssp_dev2, (SSCR0_TI | (SSCR0_DSS & 0x09 )) | SSCR0_SSE, 0, 0, SSCR0_SerClkDiv(212));
-+               printk("Stage 4: %x\n",CKEN);
-+               ssp_enable(&hx2750_ssp_dev2);
-+               printk("Stage 5: %x\n",CKEN);
-+       }
-+       printk("SSP Device2 Initialised\n");
-+
-+       printk("Sent: 0x3ff\n");
-+       ssp_write_word(&hx2750_ssp_dev2,0x3ff);
-+
-+       return;
-+}
-+
-+void hx2750_ssp2_reset(void)
-+{
-+       ssp_write_word(&hx2750_ssp_dev2,0x000);
-+       ssp_write_word(&hx2750_ssp_dev2,0x000);
-+
-+}
-+
-+unsigned long hx2750_ssp2_read(void)
-+{
-+       u32 ret = 0;
-+       ssp_read_word(&hx2750_ssp_dev2, &ret);
-+       return ret;
-+}
-+
-+void hx2750_ssp2_write(unsigned long data)
-+{
-+       ssp_write_word(&hx2750_ssp_dev2, data);
-+}
-+
-+
-+/*
-+ * Extra hx2750 Specific GPIOs
-+ */
-+void hx2750_send_egpio(unsigned int val)
-+{
-+       int i;
-+
-+       GPCR0 = GPIO_bit(HX2750_GPIO_SR_STROBE);
-+       GPCR1 = GPIO_bit(HX2750_GPIO_SR_CLK1);
-+
-+       for (i=0;i<12;i++) {
-+               if (val & 0x01)
-+                       GPSR2 = GPIO_bit(HX2750_GPIO_GPIO_DIN);
-+               else
-+                       GPCR2 = GPIO_bit(HX2750_GPIO_GPIO_DIN);
-+               val >>= 1;
-+               GPSR1 = GPIO_bit(HX2750_GPIO_SR_CLK1);
-+               GPCR1 = GPIO_bit(HX2750_GPIO_SR_CLK1);
-+       }
-+
-+       GPSR0 = GPIO_bit(HX2750_GPIO_SR_STROBE);
-+       GPCR0 = GPIO_bit(HX2750_GPIO_SR_STROBE);
-+}
-+
-+EXPORT_SYMBOL(hx2750_send_egpio);
-+
-+unsigned int hx2750_egpio_current;
-+
-+void hx2750_set_egpio(unsigned int gpio)
-+{
-+       hx2750_egpio_current|=gpio;
-+
-+       hx2750_send_egpio(hx2750_egpio_current);
-+}
-+EXPORT_SYMBOL(hx2750_set_egpio);
-+
-+void hx2750_clear_egpio(unsigned int gpio)
-+{
-+       hx2750_egpio_current&=~gpio;
-+
-+       hx2750_send_egpio(hx2750_egpio_current);
-+}
-+EXPORT_SYMBOL(hx2750_clear_egpio);
-+
-+
-+/*
-+ * Touchscreen/Sound/Battery Status
-+ */
-+void hx2750_tsc2101_send(int read, int command, int *values, int numval)
-+{
-+       u32 ret = 0;
-+       int i;
-+
-+       GPCR0 = GPIO_bit(HX2750_GPIO_TSC2101_SS);
-+
-+       ssp_write_word(&hx2750_ssp_dev1, command | read);
-+       /* dummy read */
-+       ssp_read_word(&hx2750_ssp_dev1, &ret);
-+
-+       for (i=0; i < numval; i++) {
-+               if (read) {
-+                       ssp_write_word(&hx2750_ssp_dev1, 0);
-+                       ssp_read_word(&hx2750_ssp_dev1, &values[i]);
-+               } else {
-+                       ssp_write_word(&hx2750_ssp_dev1, values[i]);
-+                       ssp_read_word(&hx2750_ssp_dev1, &ret);
-+               }
-+       }
-+
-+       GPSR0 = GPIO_bit(HX2750_GPIO_TSC2101_SS);
-+}
-+
-+static int hx2750_tsc2101_pendown(void)
-+{
-+       if ((GPLR(HX2750_GPIO_PENDOWN) & GPIO_bit(HX2750_GPIO_PENDOWN)) == 0)
-+               return 1;
-+       return 0;
-+}
-+
-+static struct tsc2101_platform_info hx2750_tsc2101_info = {
-+       .send     = hx2750_tsc2101_send,
-+       .suspend  = hx2750_ssp_suspend,
-+       .resume   = hx2750_ssp_resume,
-+       .irq      = HX2750_IRQ_GPIO_PENDOWN,
-+       .pendown  = hx2750_tsc2101_pendown,
-+};
-+
-+struct platform_device tsc2101_device = {
-+       .name           = "tsc2101",
-+       .dev            = {
-+               .platform_data  = &hx2750_tsc2101_info,
-+               //.parent = &corgissp_device.dev,
-+       },
-+       .id             = -1,
-+};
-+
-+
-+/*
-+ * MMC/SD Device
-+ *
-+ * The card detect interrupt isn't debounced so we delay it by 250ms
-+ * to give the card a chance to fully insert/eject.
-+ */
-+static struct pxamci_platform_data hx2750_mci_platform_data;
-+
-+static int hx2750_mci_init(struct device *dev, irq_handler_t hx2750_detect_int, void *data)
-+{
-+       int err;
-+
-+       /*
-+        * setup GPIO for PXA27x MMC controller
-+        */
-+       pxa_gpio_mode(GPIO32_MMCCLK_MD);
-+       pxa_gpio_mode(GPIO112_MMCCMD_MD);
-+       pxa_gpio_mode(GPIO92_MMCDAT0_MD);
-+       pxa_gpio_mode(GPIO109_MMCDAT1_MD);
-+       pxa_gpio_mode(GPIO110_MMCDAT2_MD);
-+       pxa_gpio_mode(GPIO111_MMCDAT3_MD);
-+       pxa_gpio_mode(HX2750_GPIO_SD_DETECT | GPIO_IN);
-+       pxa_gpio_mode(HX2750_GPIO_SD_READONLY | GPIO_IN);
-+
-+       hx2750_mci_platform_data.detect_delay = msecs_to_jiffies(250);
-+
-+       err = request_irq(HX2750_IRQ_GPIO_SD_DETECT, hx2750_detect_int,
-+                       IRQF_DISABLED | IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING,
-+                       "MMC card detect", data);
-+       if (err) {
-+               printk(KERN_ERR "hx2750_mci_init: MMC/SD: can't request MMC card detect IRQ\n");
-+               return -1;
-+       }
-+
-+       return 0;
-+}
-+
-+static void hx2750_mci_setpower(struct device *dev, unsigned int vdd)
-+{
-+       struct pxamci_platform_data* p_d = dev->platform_data;
-+
-+       if (( 1 << vdd) & p_d->ocr_mask)
-+               hx2750_set_egpio(HX2750_EGPIO_SD_PWR);
-+       else
-+               hx2750_clear_egpio(HX2750_EGPIO_SD_PWR);
-+}
-+
-+static void hx2750_mci_exit(struct device *dev, void *data)
-+{
-+       free_irq(HX2750_IRQ_GPIO_SD_DETECT, data);
-+}
-+
-+static struct pxamci_platform_data hx2750_mci_platform_data = {
-+       .ocr_mask       = MMC_VDD_32_33|MMC_VDD_33_34,
-+       .init           = hx2750_mci_init,
-+       .setpower       = hx2750_mci_setpower,
-+       .exit           = hx2750_mci_exit,
-+};
-+
-+
-+/*
-+ * FrameBuffer
-+ */
-+static struct pxafb_mode_info hx2750_pxafb_modes = {
-+       .pixclock       = 288462,
-+       .xres           = 240,
-+       .yres           = 320,
-+       .bpp            = 16,
-+       .hsync_len      = 20,
-+       .left_margin    = 42,
-+       .right_margin   = 18,
-+       .vsync_len      = 4,
-+       .upper_margin   = 3,
-+       .lower_margin   = 4,
-+       .sync           = 0,
-+};
-+
-+static struct pxafb_mach_info hx2750_pxafb_info = {
-+       .modes          = &hx2750_pxafb_modes,
-+       .num_modes      = 1,
-+       .fixed_modes    = 1,
-+       .lccr0          = LCCR0_Color | LCCR0_Sngl | LCCR0_Act,
-+       .lccr3          = LCCR3_PixFlEdg | LCCR3_OutEnH,
-+       .pxafb_backlight_power  = NULL,
-+};
-+
-+
-+/*
-+ * Test Device
-+ */
-+static struct platform_device hx2750_test_device = {
-+       .name           = "hx2750-test",
-+       .id             = -1,
-+};
-+
-+
-+/* Initialization code */
-+static struct platform_device *devices[] __initdata = {
-+       &hx2750_bl_device,
-+       &hx2750_test_device,
-+       &hx2750_pxa_keys,
-+       &tsc2101_device,
-+};
-+
-+static void __init hx2750_init( void )
-+{
-+       PWER = 0xC0000003;// | PWER_RTC;
-+       PFER = 0x00000003;
-+       PRER = 0x00000003;
-+
-+       PGSR0=0x00000018;
-+       PGSR1=0x00000380;
-+       PGSR2=0x00800000;
-+       PGSR3=0x00500400;
-+
-+       //PCFR |= PCFR_OPDE;
-+       PCFR=0x77;
-+       PSLR=0xff100000;
-+       //PCFR=0x10; - does not return from suspend
-+
-+       //PCFR=  0x00004040;
-+       //PSLR=  0xff400f04;
-+
-+       /* Setup Extra GPIO Bank access */
-+       pxa_gpio_mode(HX2750_GPIO_GPIO_DIN | GPIO_OUT | GPIO_DFLT_HIGH);
-+       pxa_gpio_mode(HX2750_GPIO_SR_CLK1 | GPIO_OUT | GPIO_DFLT_LOW);
-+       pxa_gpio_mode(HX2750_GPIO_SR_CLK2 | GPIO_IN);
-+       pxa_gpio_mode(HX2750_GPIO_SR_STROBE | GPIO_OUT | GPIO_DFLT_LOW);
-+
-+       /* Init Extra GPIOs - Bootloader reset default is 0x484 */
-+       /* This is 0xe84 */
-+       hx2750_set_egpio(HX2750_EGPIO_2 | HX2750_EGPIO_7 | HX2750_EGPIO_LCD_PWR | HX2750_EGPIO_BL_PWR | HX2750_EGPIO_WIFI_PWR);
-+
-+       pxa_set_udc_info(&hx2750_udc_mach_info);
-+       pxa_set_mci_info(&hx2750_mci_platform_data);
-+       set_pxa_fb_info(&hx2750_pxafb_info);
-+       hx2750_ssp_init();
-+       platform_add_devices (devices, ARRAY_SIZE (devices));
-+}
-+
-+
-+MACHINE_START(HX2750, "HP iPAQ HX2750")
-+       .phys_io        = 0x40000000,
-+       .io_pg_offst    = (io_p2v(0x40000000) >> 18) & 0xfffc,
-+       .boot_params    = 0xa0000100,
-+       .map_io         = pxa_map_io,
-+        .init_irq      = pxa_init_irq,
-+        .timer         = &pxa_timer,
-+       .init_machine   = hx2750_init,
-+MACHINE_END
-+
---- linux-2.6.24-rc1.orig/arch/arm/mach-pxa/pm.c
-+++ linux-2.6.24-rc1/arch/arm/mach-pxa/pm.c
-@@ -17,6 +17,7 @@
- #include <linux/time.h>
- 
- #include <asm/hardware.h>
-+#include <asm/mach-types.h>
- #include <asm/memory.h>
- #include <asm/system.h>
- #include <asm/arch/pm.h>
-@@ -91,6 +92,9 @@
-        .enter          = pxa_pm_enter,
- };
- 
-+unsigned long pxa_pm_pspr_value;
-+extern void pxa_cpu_resume(void);
-+
- static int __init pxa_pm_init(void)
- {
-        if (!pxa_cpu_pm_fns) {
-@@ -104,6 +108,7 @@
-                return -ENOMEM;
-        }
- 
-+       pxa_pm_pspr_value=virt_to_phys(pxa_cpu_resume);
-        suspend_set_ops(&pxa_pm_ops);
-        return 0;
- }
---- linux-2.6.24-rc1.orig/arch/arm/mach-pxa/pxa27x.c
-+++ linux-2.6.24-rc1/arch/arm/mach-pxa/pxa27x.c
-@@ -259,6 +259,8 @@
-        RESTORE(PSTR);
- }
- 
-+extern unsigned long pxa_pm_pspr_value;
-+
- void pxa27x_cpu_pm_enter(suspend_state_t state)
- {
-        extern void pxa_cpu_standby(void);
-@@ -281,7 +283,7 @@
-                break;
-        case PM_SUSPEND_MEM:
-                /* set resume return address */
--               PSPR = virt_to_phys(pxa_cpu_resume);
-+               PSPR = pxa_pm_pspr_value;
-                pxa27x_cpu_suspend(PWRMODE_SLEEP);
-                break;
-        }
---- linux-2.6.24-rc1.orig/arch/arm/mach-pxa/pxa25x.c
-+++ linux-2.6.24-rc1/arch/arm/mach-pxa/pxa25x.c
-@@ -200,6 +200,8 @@
-        RESTORE(PSTR);
- }
- 
-+extern unsigned long pxa_pm_pspr_value;
-+
- static void pxa25x_cpu_pm_enter(suspend_state_t state)
- {
-        CKEN = 0;
-@@ -207,7 +209,7 @@
-        switch (state) {
-        case PM_SUSPEND_MEM:
-                /* set resume return address */
--               PSPR = virt_to_phys(pxa_cpu_resume);
-+               PSPR = pxa_pm_pspr_value;
-                pxa25x_cpu_suspend(PWRMODE_SLEEP);
-                break;
-        }
diff --git a/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/mmcsd_no_scr_check-r2.patch b/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/mmcsd_no_scr_check-r2.patch
deleted file mode 100644
index ac2245f088..0000000000
--- a/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/mmcsd_no_scr_check-r2.patch
+++ /dev/null
@@ -1,29 +0,0 @@
----
- drivers/mmc/core/sd.c |   11 ++++++-----
- 1 file changed, 6 insertions(+), 5 deletions(-)
-
-Index: linux-2.6.23/drivers/mmc/core/sd.c
-===================================================================
---- linux-2.6.23.orig/drivers/mmc/core/sd.c     2007-10-17 11:33:26.000000000 +0200
-+++ linux-2.6.23/drivers/mmc/core/sd.c  2007-10-17 11:33:49.000000000 +0200
-@@ -173,14 +173,15 @@
- 
-        scr_struct = UNSTUFF_BITS(resp, 60, 4);
-        if (scr_struct != 0) {
--               printk(KERN_ERR "%s: unrecognised SCR structure version %d\n",
-+               printk(KERN_WARNING "%s: unrecognised SCR structure version %d\n",
-                        mmc_hostname(card->host), scr_struct);
--               return -EINVAL;
-+               scr->sda_vsn = 0;
-+               scr->bus_widths = 0;
-+       } else {
-+               scr->sda_vsn = UNSTUFF_BITS(resp, 56, 4);
-+               scr->bus_widths = UNSTUFF_BITS(resp, 48, 4);
-        }
- 
--       scr->sda_vsn = UNSTUFF_BITS(resp, 56, 4);
--       scr->bus_widths = UNSTUFF_BITS(resp, 48, 4);
--
-        return 0;
- }
- 
diff --git a/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/pda-power.patch b/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/pda-power.patch
deleted file mode 100644
index face2f4ef2..0000000000
--- a/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/pda-power.patch
+++ /dev/null
@@ -1,3373 +0,0 @@
----
- arch/arm/Kconfig                   |    2 
- drivers/Kconfig                    |    2 
- drivers/Makefile                   |    1 
- drivers/power/Kconfig              |   70 +++++
- drivers/power/Makefile             |   28 ++
- drivers/power/adc_battery.c        |  278 +++++++++++++++++++++
- drivers/power/apm_power.c          |  247 +++++++++++++++++++
- drivers/power/ds2760_battery.c     |  475 +++++++++++++++++++++++++++++++++++++
- drivers/power/micro_battery.c      |  257 ++++++++++++++++++++
- drivers/power/olpc_battery.c       |  302 +++++++++++++++++++++++
- drivers/power/pda_power.c          |  263 ++++++++++++++++++++
- drivers/power/pmu_battery.c        |  215 ++++++++++++++++
- drivers/power/power_supply.h       |   42 +++
- drivers/power/power_supply_core.c  |  168 +++++++++++++
- drivers/power/power_supply_leds.c  |  188 ++++++++++++++
- drivers/power/power_supply_sysfs.c |  289 ++++++++++++++++++++++
- drivers/power/simpad-battery.c     |  242 ++++++++++++++++++
- include/linux/power_supply.h       |  175 +++++++++++++
- 18 files changed, 3244 insertions(+)
-
-Index: linux-2.6.22/drivers/power/adc_battery.c
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/adc_battery.c    2007-08-23 12:26:28.000000000 +0200
-@@ -0,0 +1,278 @@
-+/*
-+ * Copyright (c) 2007 Paul Sokolovsky
-+ *
-+ * 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.
-+ *
-+ */
-+
-+//#define DEBUG
-+
-+#include <linux/module.h>
-+#include <linux/interrupt.h>
-+#include <linux/pm.h>
-+#include <linux/delay.h>
-+#include <linux/workqueue.h>
-+#include <linux/platform_device.h>
-+#include <linux/power_supply.h>
-+#include <linux/adc.h>
-+#include <linux/adc_battery.h>
-+
-+#include <asm/irq.h>
-+
-+#define PIN_NO_VOLT 0
-+#define PIN_NO_CURR 1
-+#define PIN_NO_TEMP 2
-+
-+struct battery_adc_priv {
-+       struct power_supply batt_cdev;
-+
-+       struct battery_adc_platform_data *pdata;
-+
-+       struct adc_request req;
-+       struct adc_sense pins[3];
-+       struct adc_sense last_good_pins[3];
-+
-+       struct workqueue_struct *wq;
-+       struct delayed_work work;
-+};
-+
-+/*
-+ *  Battery properties
-+ */
-+
-+static int adc_battery_get_property(struct power_supply *psy,
-+                                    enum power_supply_property psp,
-+                                    union power_supply_propval *val)
-+{
-+       struct battery_adc_priv* drvdata = (struct battery_adc_priv*)psy;
-+       int voltage;
-+
-+       switch (psp) {
-+       case POWER_SUPPLY_PROP_STATUS:
-+               val->intval = drvdata->pdata->charge_status;
-+               break;
-+       case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN:
-+               val->intval = drvdata->pdata->battery_info.voltage_max_design;
-+               break;
-+       case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN:
-+               val->intval = drvdata->pdata->battery_info.voltage_min_design;
-+               break;
-+       case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN:
-+               val->intval = drvdata->pdata->battery_info.charge_full_design;
-+               break;
-+       case POWER_SUPPLY_PROP_CHARGE_EMPTY_DESIGN:
-+               val->intval = drvdata->pdata->battery_info.charge_empty_design;
-+               break;
-+       case POWER_SUPPLY_PROP_VOLTAGE_NOW:
-+               val->intval = drvdata->last_good_pins[PIN_NO_VOLT].value * drvdata->pdata->voltage_mult;
-+               break;
-+       case POWER_SUPPLY_PROP_CURRENT_NOW:
-+               val->intval = drvdata->last_good_pins[PIN_NO_CURR].value * drvdata->pdata->current_mult;
-+               break;
-+       case POWER_SUPPLY_PROP_CHARGE_NOW:
-+               /* We do calculations in mX, not uX, because todo it in uX we should use "long long"s,
-+                * which is a mess (need to use do_div) when you need divide operation). */
-+               voltage = drvdata->last_good_pins[PIN_NO_VOLT].value * drvdata->pdata->voltage_mult;
-+               val->intval = ((voltage/1000 - drvdata->pdata->battery_info.voltage_min_design/1000) *
-+                    (drvdata->pdata->battery_info.charge_full_design/1000 -
-+                     drvdata->pdata->battery_info.charge_empty_design/1000)) /
-+                    (drvdata->pdata->battery_info.voltage_max_design/1000 -
-+                     drvdata->pdata->battery_info.voltage_min_design/1000);
-+               val->intval *= 1000; /* convert final result to uX */
-+               break;
-+       case POWER_SUPPLY_PROP_TEMP:
-+               val->intval = drvdata->last_good_pins[PIN_NO_TEMP].value * drvdata->pdata->temperature_mult / 1000;
-+               break;
-+       default:
-+               return -EINVAL;
-+       };
-+       return 0;
-+}
-+
-+/*
-+ *  Driver body
-+ */
-+
-+static void adc_battery_query(struct battery_adc_priv *drvdata)
-+{
-+       struct battery_adc_platform_data *pdata = drvdata->pdata;
-+       int powered, charging;
-+
-+       adc_request_sample(&drvdata->req);
-+
-+       powered = power_supply_am_i_supplied(&drvdata->batt_cdev);
-+       charging = pdata->is_charging ? pdata->is_charging() : -1;
-+
-+       if (powered && charging)
-+               pdata->charge_status = POWER_SUPPLY_STATUS_CHARGING;
-+       else if (powered && !charging && charging != -1)
-+               pdata->charge_status = POWER_SUPPLY_STATUS_FULL;
-+       else
-+               pdata->charge_status = POWER_SUPPLY_STATUS_DISCHARGING;
-+
-+       /* Throw away invalid samples, this may happen soon after resume for example. */
-+       if (drvdata->pins[PIN_NO_VOLT].value > 0) {
-+               memcpy(drvdata->last_good_pins, drvdata->pins, sizeof(drvdata->pins));
-+#ifdef DEBUG
-+               printk("%d %d %d\n", drvdata->pins[PIN_NO_VOLT].value,
-+                                    drvdata->pins[PIN_NO_CURR].value,
-+                                    drvdata->pins[PIN_NO_TEMP].value);
-+#endif
-+       }
-+}
-+
-+static void adc_battery_charge_power_changed(struct power_supply *bat)
-+{
-+       struct battery_adc_priv *drvdata = (struct battery_adc_priv*)bat;
-+       cancel_delayed_work(&drvdata->work);
-+       queue_delayed_work(drvdata->wq, &drvdata->work, 0);
-+}
-+
-+static void adc_battery_work_func(struct work_struct *work)
-+{
-+       struct delayed_work *delayed_work = container_of(work, struct delayed_work, work);
-+       struct battery_adc_priv *drvdata = container_of(delayed_work, struct battery_adc_priv, work);
-+
-+       adc_battery_query(drvdata);
-+       power_supply_changed(&drvdata->batt_cdev);
-+
-+       queue_delayed_work(drvdata->wq, &drvdata->work, (5000 * HZ) / 1000);
-+}
-+
-+static int adc_battery_probe(struct platform_device *pdev)
-+{
-+        int retval;
-+       struct battery_adc_platform_data *pdata = pdev->dev.platform_data;
-+       struct battery_adc_priv *drvdata;
-+       int i, j;
-+       enum power_supply_property props[] = {
-+               POWER_SUPPLY_PROP_STATUS,
-+               POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN,
-+               POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN,
-+               POWER_SUPPLY_PROP_VOLTAGE_NOW,
-+               POWER_SUPPLY_PROP_CURRENT_NOW,
-+               POWER_SUPPLY_PROP_CHARGE_NOW,
-+               POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN,
-+               POWER_SUPPLY_PROP_CHARGE_EMPTY_DESIGN,
-+               POWER_SUPPLY_PROP_TEMP,
-+       };
-+
-+       // Initialize ts data structure.
-+       drvdata = kzalloc(sizeof(*drvdata), GFP_KERNEL);
-+       if (!drvdata)
-+               return -ENOMEM;
-+
-+       drvdata->batt_cdev.name           = pdata->battery_info.name;
-+       drvdata->batt_cdev.use_for_apm    = pdata->battery_info.use_for_apm;
-+       drvdata->batt_cdev.num_properties = ARRAY_SIZE(props);
-+       drvdata->batt_cdev.get_property   = adc_battery_get_property;
-+       drvdata->batt_cdev.external_power_changed =
-+                                 adc_battery_charge_power_changed;
-+
-+       if (!pdata->voltage_pin) {
-+               drvdata->batt_cdev.num_properties--;
-+               props[3] = -1;
-+       }
-+       if (!pdata->current_pin) {
-+               drvdata->batt_cdev.num_properties--;
-+               props[4] = -1;
-+       }
-+       if (!pdata->temperature_pin) {
-+               drvdata->batt_cdev.num_properties--;
-+               props[8] = -1;
-+       }
-+
-+       drvdata->batt_cdev.properties = kmalloc(
-+                       sizeof(*drvdata->batt_cdev.properties) *
-+                       drvdata->batt_cdev.num_properties, GFP_KERNEL);
-+       if (!drvdata->batt_cdev.properties)
-+               return -ENOMEM;
-+
-+       j = 0;
-+       for (i = 0; i < ARRAY_SIZE(props); i++) {
-+               if (props[i] == -1)
-+                       continue;
-+               drvdata->batt_cdev.properties[j++] = props[i];
-+       }
-+
-+       retval = power_supply_register(&pdev->dev, &drvdata->batt_cdev);
-+       if (retval) {
-+               printk("adc-battery: Error registering battery classdev");
-+               return retval;
-+       }
-+
-+       drvdata->req.senses = drvdata->pins;
-+       drvdata->req.num_senses = ARRAY_SIZE(drvdata->pins);
-+       drvdata->pins[PIN_NO_VOLT].name = pdata->voltage_pin;
-+       drvdata->pins[PIN_NO_CURR].name = pdata->current_pin;
-+       drvdata->pins[PIN_NO_TEMP].name = pdata->temperature_pin;
-+
-+       adc_request_register(&drvdata->req);
-+
-+       /* Here we assume raw values in mV */
-+       if (!pdata->voltage_mult)
-+               pdata->voltage_mult = 1000;
-+       /* Here we assume raw values in mA */
-+       if (!pdata->current_mult)
-+               pdata->current_mult = 1000;
-+       /* Here we assume raw values in 1/10 C */
-+       if (!pdata->temperature_mult)
-+               pdata->temperature_mult = 1000;
-+
-+       drvdata->pdata = pdata;
-+       pdata->drvdata = drvdata; /* Seems ugly, we need better solution */
-+
-+       platform_set_drvdata(pdev, drvdata);
-+
-+        // Load initial values ASAP
-+       adc_battery_query(drvdata);
-+
-+       // Still schedule next sampling soon
-+       INIT_DELAYED_WORK(&drvdata->work, adc_battery_work_func);
-+       drvdata->wq = create_workqueue(pdev->dev.bus_id);
-+       if (!drvdata->wq)
-+               return -ESRCH;
-+
-+       queue_delayed_work(drvdata->wq, &drvdata->work, (5000 * HZ) / 1000);
-+
-+       return retval;
-+}
-+
-+static int adc_battery_remove(struct platform_device *pdev)
-+{
-+       struct battery_adc_priv *drvdata = platform_get_drvdata(pdev);
-+       cancel_delayed_work(&drvdata->work);
-+       destroy_workqueue(drvdata->wq);
-+       power_supply_unregister(&drvdata->batt_cdev);
-+       adc_request_unregister(&drvdata->req);
-+       kfree(drvdata->batt_cdev.properties);
-+       return 0;
-+}
-+
-+static struct platform_driver adc_battery_driver = {
-+       .driver         = {
-+               .name   = "adc-battery",
-+       },
-+       .probe          = adc_battery_probe,
-+       .remove         = adc_battery_remove,
-+};
-+
-+static int __init adc_battery_init(void)
-+{
-+       return platform_driver_register(&adc_battery_driver);
-+}
-+
-+static void __exit adc_battery_exit(void)
-+{
-+       platform_driver_unregister(&adc_battery_driver);
-+}
-+
-+module_init(adc_battery_init)
-+module_exit(adc_battery_exit)
-+
-+MODULE_AUTHOR("Paul Sokolovsky");
-+MODULE_DESCRIPTION("Battery driver for ADC device");
-+MODULE_LICENSE("GPL");
-Index: linux-2.6.22/drivers/power/apm_power.c
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/apm_power.c      2007-08-23 12:13:52.000000000 +0200
-@@ -0,0 +1,247 @@
-+/*
-+ * Copyright (c) 2007 Anton Vorontsov <cbou@mail.ru>
-+ * Copyright (c) 2007 Eugeny Boger <eugenyboger@dgap.mipt.ru>
-+ *
-+ * Author: Eugeny Boger <eugenyboger@dgap.mipt.ru>
-+ *
-+ * Use consistent with the GNU GPL is permitted,
-+ * provided that this copyright notice is
-+ * preserved in its entirety in all copies and derived works.
-+ */
-+
-+#include <linux/module.h>
-+#include <linux/power_supply.h>
-+#include <linux/apm-emulation.h>
-+
-+#define PSY_PROP(psy, prop, val) psy->get_property(psy, \
-+                         POWER_SUPPLY_PROP_##prop, val)
-+
-+#define _MPSY_PROP(prop, val) main_battery->get_property(main_battery, \
-+                                                         prop, val)
-+
-+#define MPSY_PROP(prop, val) _MPSY_PROP(POWER_SUPPLY_PROP_##prop, val)
-+
-+static struct power_supply *main_battery;
-+
-+static void find_main_battery(void)
-+{
-+       struct device *dev;
-+       struct power_supply *bat, *batm;
-+       union power_supply_propval full;
-+       int max_charge = 0;
-+
-+       main_battery = NULL;
-+       batm = NULL;
-+       list_for_each_entry(dev, &power_supply_class->devices, node) {
-+               bat = dev_get_drvdata(dev);
-+               /* If none of battery devices cantains 'use_for_apm' flag,
-+                  choice one with maximum design charge */
-+               if (!PSY_PROP(bat, CHARGE_FULL_DESIGN, &full)) {
-+                       if (full.intval > max_charge) {
-+                               batm = bat;
-+                               max_charge = full.intval;
-+                       }
-+               }
-+
-+               if (bat->use_for_apm)
-+                       main_battery = bat;
-+       }
-+       if (!main_battery)
-+               main_battery = batm;
-+
-+       return;
-+}
-+
-+static int calculate_time(int status)
-+{
-+       union power_supply_propval charge_full, charge_empty;
-+       union power_supply_propval charge, I;
-+
-+       if (MPSY_PROP(CHARGE_FULL, &charge_full)) {
-+               /* if battery can't report this property, use design value */
-+               if (MPSY_PROP(CHARGE_FULL_DESIGN, &charge_full))
-+                       return -1;
-+       }
-+
-+       if (MPSY_PROP(CHARGE_EMPTY, &charge_empty)) {
-+               /* if battery can't report this property, use design value */
-+               if (MPSY_PROP(CHARGE_EMPTY_DESIGN, &charge_empty))
-+                       charge_empty.intval = 0;
-+       }
-+
-+       if (MPSY_PROP(CHARGE_AVG, &charge)) {
-+               /* if battery can't report average value, use momentary */
-+               if (MPSY_PROP(CHARGE_NOW, &charge))
-+                       return -1;
-+       }
-+
-+       if (MPSY_PROP(CURRENT_AVG, &I)) {
-+               /* if battery can't report average value, use momentary */
-+               if (MPSY_PROP(CURRENT_NOW, &I))
-+                       return -1;
-+       }
-+
-+       if (I.intval == 0)
-+               return 0;
-+       else if (status == POWER_SUPPLY_STATUS_CHARGING)
-+               return ((charge.intval - charge_full.intval) * 60L) /
-+                      I.intval;
-+       else
-+               return -((charge.intval - charge_empty.intval) * 60L) /
-+                       I.intval;
-+}
-+
-+static int calculate_capacity(int using_charge)
-+{
-+       enum power_supply_property full_prop, empty_prop;
-+       enum power_supply_property full_design_prop, empty_design_prop;
-+       enum power_supply_property now_prop, avg_prop;
-+       union power_supply_propval empty, full, cur;
-+       int ret;
-+
-+       if (using_charge) {
-+               full_prop = POWER_SUPPLY_PROP_CHARGE_FULL;
-+               empty_prop = POWER_SUPPLY_PROP_CHARGE_EMPTY;
-+               full_design_prop = POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN;
-+               empty_design_prop = POWER_SUPPLY_PROP_CHARGE_EMPTY_DESIGN;
-+               now_prop = POWER_SUPPLY_PROP_CHARGE_NOW;
-+               avg_prop = POWER_SUPPLY_PROP_CHARGE_AVG;
-+       }
-+       else {
-+               full_prop = POWER_SUPPLY_PROP_ENERGY_FULL;
-+               empty_prop = POWER_SUPPLY_PROP_ENERGY_EMPTY;
-+               full_design_prop = POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN;
-+               empty_design_prop = POWER_SUPPLY_PROP_ENERGY_EMPTY_DESIGN;
-+               now_prop = POWER_SUPPLY_PROP_ENERGY_NOW;
-+               avg_prop = POWER_SUPPLY_PROP_ENERGY_AVG;
-+       }
-+
-+       if (_MPSY_PROP(full_prop, &full)) {
-+               /* if battery can't report this property, use design value */
-+               if (_MPSY_PROP(full_design_prop, &full))
-+                       return -1;
-+       }
-+
-+       if (_MPSY_PROP(avg_prop, &cur)) {
-+               /* if battery can't report average value, use momentary */
-+               if (_MPSY_PROP(now_prop, &cur))
-+                       return -1;
-+       }
-+
-+       if (_MPSY_PROP(empty_prop, &empty)) {
-+               /* if battery can't report this property, use design value */
-+               if (_MPSY_PROP(empty_design_prop, &empty))
-+                       empty.intval = 0;
-+       }
-+
-+       if (full.intval - empty.intval)
-+               ret =  ((cur.intval - empty.intval) * 100L) /
-+                      (full.intval - empty.intval);
-+       else
-+               return -1;
-+
-+       if (ret > 100)
-+               return 100;
-+       else if (ret < 0)
-+               return 0;
-+
-+       return ret;
-+}
-+
-+static void apm_battery_apm_get_power_status(struct apm_power_info *info)
-+{
-+       union power_supply_propval status;
-+       union power_supply_propval capacity, time_to_full, time_to_empty;
-+
-+       down(&power_supply_class->sem);
-+       find_main_battery();
-+       if (!main_battery) {
-+               up(&power_supply_class->sem);
-+               return;
-+       }
-+
-+       /* status */
-+
-+       if (MPSY_PROP(STATUS, &status))
-+               status.intval = POWER_SUPPLY_STATUS_UNKNOWN;
-+
-+       /* ac line status */
-+
-+       if ((status.intval == POWER_SUPPLY_STATUS_CHARGING) ||
-+           (status.intval == POWER_SUPPLY_STATUS_NOT_CHARGING) ||
-+           (status.intval == POWER_SUPPLY_STATUS_FULL))
-+               info->ac_line_status = APM_AC_ONLINE;
-+       else
-+               info->ac_line_status = APM_AC_OFFLINE;
-+
-+       /* battery life (i.e. capacity, in percents) */
-+
-+       if (MPSY_PROP(CAPACITY, &capacity) == 0)
-+               info->battery_life = capacity.intval;
-+       else {
-+               /* try calculate using energy */
-+               info->battery_life = calculate_capacity(0);
-+               /* if failed try calculate using charge instead */
-+               if (info->battery_life == -1)
-+                       info->battery_life = calculate_capacity(1);
-+       }
-+
-+       /* charging status */
-+
-+       if (status.intval == POWER_SUPPLY_STATUS_CHARGING)
-+               info->battery_status = APM_BATTERY_STATUS_CHARGING;
-+       else {
-+               if (info->battery_life > 50)
-+                       info->battery_status = APM_BATTERY_STATUS_HIGH;
-+               else if (info->battery_life > 5)
-+                       info->battery_status = APM_BATTERY_STATUS_LOW;
-+               else
-+                       info->battery_status = APM_BATTERY_STATUS_CRITICAL;
-+       }
-+       info->battery_flag = info->battery_status;
-+
-+       /* time */
-+
-+       info->units = APM_UNITS_MINS;
-+
-+       if (status.intval == POWER_SUPPLY_STATUS_CHARGING) {
-+               if (MPSY_PROP(TIME_TO_FULL_AVG, &time_to_full)) {
-+                       if (MPSY_PROP(TIME_TO_FULL_NOW, &time_to_full))
-+                               info->time = calculate_time(status.intval);
-+                       else
-+                               info->time = time_to_full.intval / 60;
-+               }
-+       }
-+       else {
-+               if (MPSY_PROP(TIME_TO_EMPTY_AVG, &time_to_empty)) {
-+                       if (MPSY_PROP(TIME_TO_EMPTY_NOW, &time_to_empty))
-+                               info->time = calculate_time(status.intval);
-+                       else
-+                               info->time = time_to_empty.intval / 60;
-+               }
-+       }
-+
-+       up(&power_supply_class->sem);
-+       return;
-+}
-+
-+static int __init apm_battery_init(void)
-+{
-+       printk(KERN_INFO "APM Battery Driver\n");
-+
-+       apm_get_power_status = apm_battery_apm_get_power_status;
-+       return 0;
-+}
-+
-+static void __exit apm_battery_exit(void)
-+{
-+       apm_get_power_status = NULL;
-+       return;
-+}
-+
-+module_init(apm_battery_init);
-+module_exit(apm_battery_exit);
-+
-+MODULE_AUTHOR("Eugeny Boger <eugenyboger@dgap.mipt.ru>");
-+MODULE_DESCRIPTION("APM emulation driver for battery monitoring class");
-+MODULE_LICENSE("GPL");
-Index: linux-2.6.22/drivers/power/ds2760_battery.c
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/ds2760_battery.c 2007-08-23 12:13:52.000000000 +0200
-@@ -0,0 +1,475 @@
-+/*
-+ * Driver for batteries with DS2760 chips inside.
-+ *
-+ * Copyright (c) 2007 Anton Vorontsov
-+ *               2004-2007 Matt Reimer
-+ *               2004 Szabolcs Gyurko
-+ *
-+ * Use consistent with the GNU GPL is permitted,
-+ * provided that this copyright notice is
-+ * preserved in its entirety in all copies and derived works.
-+ *
-+ * Author:  Anton Vorontsov <cbou@mail.ru>
-+ *          February 2007
-+ *
-+ *          Matt Reimer <mreimer@vpop.net>
-+ *          April 2004, 2005, 2007
-+ *
-+ *          Szabolcs Gyurko <szabolcs.gyurko@tlt.hu>
-+ *          September 2004
-+ */
-+
-+#include <linux/module.h>
-+#include <linux/param.h>
-+#include <linux/jiffies.h>
-+#include <linux/workqueue.h>
-+#include <linux/pm.h>
-+#include <linux/platform_device.h>
-+#include <linux/power_supply.h>
-+
-+#include "../w1/w1.h"
-+#include "../w1/slaves/w1_ds2760.h"
-+
-+struct ds2760_device_info {
-+       struct device *dev;
-+
-+       /* DS2760 data, valid after calling ds2760_battery_read_status() */
-+       unsigned long update_time;      /* jiffies when data read */
-+       char raw[DS2760_DATA_SIZE];     /* raw DS2760 data */
-+       int voltage_raw;                /* units of 4.88 mV */
-+       int voltage_uV;                 /* units of uV */
-+       int current_raw;                /* units of 0.625 mA */
-+       int current_uA;                 /* units of uA */
-+       int accum_current_raw;          /* units of 0.25 mAh */
-+       int accum_current_uAh;          /* units of uAh */
-+       int temp_raw;                   /* units of 0.125 C */
-+       int temp_C;                     /* units of 0.1 C */
-+       int rated_capacity;             /* units of uAh */
-+       int rem_capacity;               /* percentage */
-+       int full_active_uAh;            /* units of uAh */
-+       int empty_uAh;                  /* units of uAh */
-+       int life_sec;                   /* units of seconds */
-+       int charge_status;              /* POWER_SUPPLY_STATUS_* */
-+
-+       int full_counter;
-+       struct power_supply bat;
-+       struct device *w1_dev;
-+       struct workqueue_struct *monitor_wqueue;
-+       struct delayed_work monitor_work;
-+};
-+
-+static unsigned int cache_time = 1000;
-+module_param(cache_time, uint, 0644);
-+MODULE_PARM_DESC(cache_time, "cache time in milliseconds");
-+
-+/* Some batteries have their rated capacity stored a N * 10 mAh, while
-+ * others use an index into this table. */
-+static int rated_capacities[] = {
-+       0,
-+       920,        /* Samsung */
-+       920,        /* BYD */
-+       920,        /* Lishen */
-+       920,        /* NEC */
-+       1440,       /* Samsung */
-+       1440,       /* BYD */
-+       1440,       /* Lishen */
-+       1440,       /* NEC */
-+       2880,       /* Samsung */
-+       2880,       /* BYD */
-+       2880,       /* Lishen */
-+       2880        /* NEC */
-+};
-+
-+/* array is level at temps 0C, 10C, 20C, 30C, 40C
-+ * temp is in Celsius */
-+static int battery_interpolate(int array[], int temp)
-+{
-+       int index, dt;
-+
-+       if (temp <= 0)
-+               return array[0];
-+       if (temp >= 40)
-+               return array[4];
-+
-+       index = temp / 10;
-+       dt    = temp % 10;
-+
-+       return array[index] + (((array[index + 1] - array[index]) * dt) / 10);
-+}
-+
-+static int ds2760_battery_read_status(struct ds2760_device_info *di)
-+{
-+       int ret, i, start, count, scale[5];
-+
-+       if (di->update_time && time_before(jiffies, di->update_time +
-+                                          msecs_to_jiffies(cache_time)))
-+               return 0;
-+
-+       /* The first time we read the entire contents of SRAM/EEPROM,
-+        * but after that we just read the interesting bits that change. */
-+       if (di->update_time == 0) {
-+               start = 0;
-+               count = DS2760_DATA_SIZE;
-+       }
-+       else {
-+               start = DS2760_VOLTAGE_MSB;
-+               count = DS2760_TEMP_LSB - start + 1;
-+       }
-+
-+       ret = w1_ds2760_read(di->w1_dev, di->raw + start, start, count);
-+       if (ret != count) {
-+               dev_warn(di->dev, "call to w1_ds2760_read failed (0x%p)\n",
-+                        di->w1_dev);
-+               return 1;
-+       }
-+
-+       di->update_time = jiffies;
-+
-+       /* DS2760 reports voltage in units of 4.88mV, but the battery class
-+        * reports in units of uV, so convert by multiplying by 4880. */
-+       di->voltage_raw = (di->raw[DS2760_VOLTAGE_MSB] << 3) |
-+                         (di->raw[DS2760_VOLTAGE_LSB] >> 5);
-+       di->voltage_uV = di->voltage_raw * 4880;
-+
-+       /* DS2760 reports current in signed units of 0.625mA, but the battery
-+        * class reports in units of uA, so convert by multiplying by 625. */
-+       di->current_raw =
-+           (((signed char)di->raw[DS2760_CURRENT_MSB]) << 5) |
-+                         (di->raw[DS2760_CURRENT_LSB] >> 3);
-+       di->current_uA = di->current_raw * 625;
-+
-+       /* DS2760 reports accumulated current in signed units of 0.25mAh. */
-+       di->accum_current_raw =
-+           (((signed char)di->raw[DS2760_CURRENT_ACCUM_MSB]) << 8) |
-+                          di->raw[DS2760_CURRENT_ACCUM_LSB];
-+       di->accum_current_uAh = di->accum_current_raw * 250;
-+
-+       /* DS2760 reports temperature in signed units of 0.125C, but the
-+        * battery class reports in units of 1/10 C, so we convert by
-+        * multiplying by .125 * 10 = 1.25. */
-+       di->temp_raw = (((signed char)di->raw[DS2760_TEMP_MSB]) << 3) |
-+                                    (di->raw[DS2760_TEMP_LSB] >> 5);
-+       di->temp_C = di->temp_raw + (di->temp_raw / 4);
-+
-+       /* At least some battery monitors (e.g. HP iPAQ) store the battery's
-+        * maximum rated capacity. */
-+       if (di->raw[DS2760_RATED_CAPACITY] < ARRAY_SIZE(rated_capacities))
-+               di->rated_capacity = rated_capacities[
-+                       (unsigned int)di->raw[DS2760_RATED_CAPACITY]];
-+       else
-+               di->rated_capacity = di->raw[DS2760_RATED_CAPACITY] * 10;
-+
-+       di->rated_capacity *= 1000; /* convert to uAh */
-+
-+       /* Calculate the full level at the present temperature. */
-+       di->full_active_uAh = di->raw[DS2760_ACTIVE_FULL] << 8 |
-+                             di->raw[DS2760_ACTIVE_FULL + 1];
-+
-+       scale[0] = di->raw[DS2760_ACTIVE_FULL] << 8 |
-+                  di->raw[DS2760_ACTIVE_FULL + 1];
-+       for (i = 1; i < 5; i++)
-+               scale[i] = scale[i - 1] + di->raw[DS2760_ACTIVE_FULL + 2 + i];
-+
-+       di->full_active_uAh = battery_interpolate(scale, di->temp_C / 10);
-+       di->full_active_uAh *= 1000; /* convert to uAh */
-+
-+       /* Calculate the empty level at the present temperature. */
-+       scale[4] = di->raw[DS2760_ACTIVE_EMPTY + 4];
-+       for (i = 3; i >= 0; i--)
-+               scale[i] = scale[i + 1] + di->raw[DS2760_ACTIVE_EMPTY + i];
-+
-+       di->empty_uAh = battery_interpolate(scale, di->temp_C / 10);
-+       di->empty_uAh *= 1000; /* convert to uAh */
-+
-+       /* From Maxim Application Note 131: remaining capacity =
-+        * ((ICA - Empty Value) / (Full Value - Empty Value)) x 100% */
-+       di->rem_capacity = ((di->accum_current_uAh - di->empty_uAh) * 100L) /
-+                           (di->full_active_uAh - di->empty_uAh);
-+
-+       if (di->rem_capacity < 0)
-+               di->rem_capacity = 0;
-+       if (di->rem_capacity > 100)
-+               di->rem_capacity = 100;
-+
-+       if (di->current_uA)
-+               di->life_sec = -((di->accum_current_uAh - di->empty_uAh) *
-+                                3600L) / di->current_uA;
-+       else
-+               di->life_sec = 0;
-+
-+       return 0;
-+}
-+
-+static void ds2760_battery_update_status(struct ds2760_device_info *di)
-+{
-+       int old_charge_status = di->charge_status;
-+
-+       ds2760_battery_read_status(di);
-+
-+       if (di->charge_status == POWER_SUPPLY_STATUS_UNKNOWN)
-+               di->full_counter = 0;
-+
-+       if (power_supply_am_i_supplied(&di->bat)) {
-+               if (di->current_uA > 10000) {
-+                       di->charge_status = POWER_SUPPLY_STATUS_CHARGING;
-+                       di->full_counter = 0;
-+               }
-+               else if (di->current_uA < -5000) {
-+                       if (di->charge_status != POWER_SUPPLY_STATUS_NOT_CHARGING)
-+                               dev_notice(di->dev, "not enough power to "
-+                                          "charge\n");
-+                       di->charge_status = POWER_SUPPLY_STATUS_NOT_CHARGING;
-+                       di->full_counter = 0;
-+               }
-+               else if (di->current_uA < 10000 &&
-+                           di->charge_status != POWER_SUPPLY_STATUS_FULL) {
-+
-+                       /* Don't consider the battery to be full unless
-+                        * we've seen the current < 10 mA at least two
-+                        * consecutive times. */
-+
-+                       di->full_counter++;
-+
-+                       if (di->full_counter < 2)
-+                               di->charge_status = POWER_SUPPLY_STATUS_CHARGING;
-+                       else {
-+                               unsigned char acr[2];
-+                               int acr_val;
-+
-+                               /* acr is in units of 0.25 mAh */
-+                               acr_val = di->full_active_uAh * 4L / 1000;
-+
-+                               acr[0] = acr_val >> 8;
-+                               acr[1] = acr_val & 0xff;
-+
-+                               if (w1_ds2760_write(di->w1_dev, acr,
-+                                   DS2760_CURRENT_ACCUM_MSB, 2) < 2)
-+                                       dev_warn(di->dev,
-+                                                "ACR reset failed\n");
-+
-+                               di->charge_status = POWER_SUPPLY_STATUS_FULL;
-+                       }
-+               }
-+       }
-+       else {
-+               di->charge_status = POWER_SUPPLY_STATUS_DISCHARGING;
-+               di->full_counter = 0;
-+       }
-+
-+       if (di->charge_status != old_charge_status)
-+               power_supply_changed(&di->bat);
-+
-+       return;
-+}
-+
-+static void ds2760_battery_work(struct work_struct *work)
-+{
-+       struct ds2760_device_info *di = container_of(work,
-+               struct ds2760_device_info, monitor_work.work);
-+       const int interval = HZ * 60;
-+
-+       dev_dbg(di->dev, "%s\n", __FUNCTION__);
-+
-+       ds2760_battery_update_status(di);
-+       queue_delayed_work(di->monitor_wqueue, &di->monitor_work, interval);
-+
-+       return;
-+}
-+
-+#define to_ds2760_device_info(x) container_of((x), struct ds2760_device_info, \
-+                                              bat);
-+
-+static void ds2760_battery_external_power_changed(struct power_supply *psy)
-+{
-+       struct ds2760_device_info *di = to_ds2760_device_info(psy);
-+
-+       dev_dbg(di->dev, "%s\n", __FUNCTION__);
-+
-+       cancel_delayed_work(&di->monitor_work);
-+       queue_delayed_work(di->monitor_wqueue, &di->monitor_work, HZ/10);
-+
-+       return;
-+}
-+
-+static int ds2760_battery_get_property(struct power_supply *psy,
-+                                       enum power_supply_property psp,
-+                                       union power_supply_propval *val)
-+{
-+       struct ds2760_device_info *di = to_ds2760_device_info(psy);
-+
-+       switch (psp) {
-+       case POWER_SUPPLY_PROP_STATUS:
-+               val->intval = di->charge_status;
-+               return 0;
-+       default:
-+               break;
-+       }
-+
-+       ds2760_battery_read_status(di);
-+
-+       switch (psp) {
-+       case POWER_SUPPLY_PROP_VOLTAGE_NOW:
-+               val->intval = di->voltage_uV;
-+               break;
-+       case POWER_SUPPLY_PROP_CURRENT_NOW:
-+               val->intval = di->current_uA;
-+               break;
-+       case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN:
-+               val->intval = di->rated_capacity;
-+               break;
-+       case POWER_SUPPLY_PROP_CHARGE_FULL:
-+               val->intval = di->full_active_uAh;
-+               break;
-+       case POWER_SUPPLY_PROP_CHARGE_EMPTY:
-+               val->intval = di->empty_uAh;
-+               break;
-+       case POWER_SUPPLY_PROP_CHARGE_NOW:
-+               val->intval = di->accum_current_uAh;
-+               break;
-+       case POWER_SUPPLY_PROP_TEMP:
-+               val->intval = di->temp_C;
-+               break;
-+       default:
-+               return -EINVAL;
-+       }
-+
-+       return 0;
-+}
-+
-+static enum power_supply_property ds2760_battery_props[] = {
-+       POWER_SUPPLY_PROP_STATUS,
-+       POWER_SUPPLY_PROP_VOLTAGE_NOW,
-+       POWER_SUPPLY_PROP_CURRENT_NOW,
-+       POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN,
-+       POWER_SUPPLY_PROP_CHARGE_FULL,
-+       POWER_SUPPLY_PROP_CHARGE_EMPTY,
-+       POWER_SUPPLY_PROP_CHARGE_NOW,
-+       POWER_SUPPLY_PROP_TEMP,
-+};
-+
-+static int ds2760_battery_probe(struct platform_device *pdev)
-+{
-+       int retval = 0;
-+       struct ds2760_device_info *di;
-+       struct ds2760_platform_data *pdata;
-+
-+       di = kzalloc(sizeof(*di), GFP_KERNEL);
-+       if (!di) {
-+               retval = -ENOMEM;
-+               goto di_alloc_failed;
-+       }
-+
-+       platform_set_drvdata(pdev, di);
-+
-+       pdata = pdev->dev.platform_data;
-+       di->dev                = &pdev->dev;
-+       di->w1_dev             = pdev->dev.parent;
-+       di->bat.name           = pdev->dev.bus_id;
-+       di->bat.type           = POWER_SUPPLY_TYPE_BATTERY;
-+       di->bat.properties     = ds2760_battery_props;
-+       di->bat.num_properties = ARRAY_SIZE(ds2760_battery_props);
-+       di->bat.get_property   = ds2760_battery_get_property;
-+       di->bat.external_power_changed =
-+                                 ds2760_battery_external_power_changed;
-+       di->bat.use_for_apm = 1;
-+
-+       di->charge_status = POWER_SUPPLY_STATUS_UNKNOWN;
-+
-+       retval = power_supply_register(&pdev->dev, &di->bat);
-+       if (retval) {
-+               dev_err(di->dev, "failed to register battery");
-+               goto batt_failed;
-+       }
-+
-+       INIT_DELAYED_WORK(&di->monitor_work, ds2760_battery_work);
-+       di->monitor_wqueue = create_singlethread_workqueue(pdev->dev.bus_id);
-+       if (!di->monitor_wqueue) {
-+               retval = -ESRCH;
-+               goto workqueue_failed;
-+       }
-+       queue_delayed_work(di->monitor_wqueue, &di->monitor_work, HZ * 1);
-+
-+       goto success;
-+
-+workqueue_failed:
-+       power_supply_unregister(&di->bat);
-+batt_failed:
-+       kfree(di);
-+di_alloc_failed:
-+success:
-+       return retval;
-+}
-+
-+static int ds2760_battery_remove(struct platform_device *pdev)
-+{
-+       struct ds2760_device_info *di = platform_get_drvdata(pdev);
-+
-+       cancel_rearming_delayed_workqueue(di->monitor_wqueue,
-+                                         &di->monitor_work);
-+       destroy_workqueue(di->monitor_wqueue);
-+       power_supply_unregister(&di->bat);
-+
-+       return 0;
-+}
-+
-+#ifdef CONFIG_PM
-+
-+static int ds2760_battery_suspend(struct platform_device *pdev,
-+                                  pm_message_t state)
-+{
-+       struct ds2760_device_info *di = platform_get_drvdata(pdev);
-+
-+       di->charge_status = POWER_SUPPLY_STATUS_UNKNOWN;
-+
-+       return 0;
-+}
-+
-+static int ds2760_battery_resume(struct platform_device *pdev)
-+{
-+       struct ds2760_device_info *di = platform_get_drvdata(pdev);
-+
-+       di->charge_status = POWER_SUPPLY_STATUS_UNKNOWN;
-+       power_supply_changed(&di->bat);
-+
-+       cancel_delayed_work(&di->monitor_work);
-+       queue_delayed_work(di->monitor_wqueue, &di->monitor_work, HZ);
-+
-+       return 0;
-+}
-+
-+#else
-+
-+#define ds2760_battery_suspend NULL
-+#define ds2760_battery_resume NULL
-+
-+#endif /* CONFIG_PM */
-+
-+static struct platform_driver ds2760_battery_driver = {
-+       .driver = {
-+               .name = "ds2760-battery",
-+       },
-+       .probe    = ds2760_battery_probe,
-+       .remove   = ds2760_battery_remove,
-+       .suspend  = ds2760_battery_suspend,
-+       .resume   = ds2760_battery_resume,
-+};
-+
-+static int __init ds2760_battery_init(void)
-+{
-+       return platform_driver_register(&ds2760_battery_driver);
-+}
-+
-+static void __exit ds2760_battery_exit(void)
-+{
-+       platform_driver_unregister(&ds2760_battery_driver);
-+       return;
-+}
-+
-+module_init(ds2760_battery_init);
-+module_exit(ds2760_battery_exit);
-+
-+MODULE_LICENSE("GPL");
-+MODULE_AUTHOR("Szabolcs Gyurko <szabolcs.gyurko@tlt.hu>, "
-+              "Matt Reimer <mreimer@vpop.net>, "
-+              "Anton Vorontsov <cbou@mail.ru>");
-+MODULE_DESCRIPTION("ds2760 battery driver");
-Index: linux-2.6.22/drivers/power/Kconfig
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/Kconfig  2007-08-23 12:13:52.000000000 +0200
-@@ -0,0 +1,70 @@
-+menuconfig POWER_SUPPLY
-+       tristate "Power supply class support"
-+       help
-+         Say Y here to enable power supply class support. This allows
-+         power supply (batteries, AC, USB) monitoring by userspace
-+         via sysfs and uevent (if available) and/or APM kernel interface
-+         (if selected below).
-+
-+if POWER_SUPPLY
-+
-+config POWER_SUPPLY_DEBUG
-+       bool "Power supply debug"
-+       help
-+         Say Y here to enable debugging messages for power supply class
-+         and drivers.
-+
-+config PDA_POWER
-+       tristate "Generic PDA/phone power driver"
-+       help
-+         Say Y here to enable generic power driver for PDAs and phones with
-+         one or two external power supplies (AC/USB) connected to main and
-+         backup batteries, and optional builtin charger.
-+
-+config APM_POWER
-+       tristate "APM emulation for class batteries"
-+       depends on APM_EMULATION
-+       help
-+         Say Y here to enable support APM status emulation using
-+         battery class devices.
-+
-+config BATTERY_DS2760
-+       tristate "DS2760 battery driver (HP iPAQ & others)"
-+       select W1
-+       select W1_SLAVE_DS2760
-+       help
-+         Say Y here to enable support for batteries with ds2760 chip.
-+
-+config BATTERY_PMU
-+       tristate "Apple PMU battery"
-+       depends on ADB_PMU
-+       help
-+         Say Y here to expose battery information on Apple machines
-+         through the generic battery class.
-+
-+config BATTERY_OLPC
-+       tristate "One Laptop Per Child battery"
-+       depends on X86_32
-+       help
-+         Say Y to enable support for the battery on the OLPC laptop.
-+
-+# drivers below are not in battery2-2.6 tree
-+
-+config ADC_BATTERY
-+       tristate "Generic ADC battery driver"
-+       depends on ADC && POWER_SUPPLY
-+       help
-+         Say Y here to enable support for battery monitoring using generic ADC device.
-+
-+config IPAQ_MICRO_BATTERY
-+       tristate "HP iPAQ Micro ASIC battery driver"
-+       depends on IPAQ_MICRO && POWER_SUPPLY
-+       help
-+         Choose this option if you want to monitor battery status on
-+         Compaq/HP iPAQ h3100 h3600
-+
-+config MCP_UCB1x00_SIMPAD_BATTERY
-+       tristate "SIMpad Battery Reading Support"
-+       depends on MCP_UCB1x00 && POWER_SUPPLY
-+
-+endif # POWER_SUPPLY
-Index: linux-2.6.22/drivers/power/Makefile
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/Makefile 2007-08-23 12:13:52.000000000 +0200
-@@ -0,0 +1,28 @@
-+power_supply-objs := power_supply_core.o
-+
-+ifeq ($(CONFIG_SYSFS),y)
-+power_supply-objs += power_supply_sysfs.o
-+endif
-+
-+ifeq ($(CONFIG_LEDS_TRIGGERS),y)
-+power_supply-objs += power_supply_leds.o
-+endif
-+
-+ifeq ($(CONFIG_POWER_SUPPLY_DEBUG),y)
-+EXTRA_CFLAGS += -DDEBUG
-+endif
-+
-+obj-$(CONFIG_POWER_SUPPLY)         += power_supply.o
-+
-+obj-$(CONFIG_PDA_POWER)            += pda_power.o
-+obj-$(CONFIG_APM_POWER)            += apm_power.o
-+
-+obj-$(CONFIG_BATTERY_DS2760)       += ds2760_battery.o
-+obj-$(CONFIG_BATTERY_PMU)          += pmu_battery.o
-+obj-$(CONFIG_BATTERY_OLPC)         += olpc_battery.o
-+
-+# drivers below are not in battery2-2.6 tree
-+
-+obj-$(CONFIG_ADC_BATTERY)          += adc_battery.o
-+obj-$(CONFIG_IPAQ_MICRO_BATTERY)   += micro_battery.o
-+obj-$(CONFIG_MCP_UCB1x00_SIMPAD_BATTERY) += simpad-battery.o
-Index: linux-2.6.22/drivers/power/micro_battery.c
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/micro_battery.c  2007-08-23 12:25:20.000000000 +0200
-@@ -0,0 +1,257 @@
-+/*
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * h3600 atmel micro companion support, battery subdevice
-+ * based on previous kernel 2.4 version
-+ * Author : Alessandro Gardich <gremlin@gremlin.it>
-+ *
-+ */
-+
-+
-+#include <linux/module.h>
-+#include <linux/version.h>
-+
-+#include <linux/init.h>
-+#include <linux/fs.h>
-+#include <linux/interrupt.h>
-+#include <linux/sched.h>
-+#include <linux/pm.h>
-+#include <linux/sysctl.h>
-+#include <linux/proc_fs.h>
-+#include <linux/delay.h>
-+#include <linux/device.h>
-+#include <linux/power_supply.h>
-+#include <linux/platform_device.h>
-+#include <linux/timer.h>
-+
-+#include <asm/arch/hardware.h>
-+
-+#include <asm/arch/h3600.h>
-+#include <asm/arch/SA-1100.h>
-+
-+#include <asm/hardware/micro.h>
-+
-+#define BATT_PERIOD 10*HZ
-+
-+#define H3600_BATT_STATUS_HIGH         0x01
-+#define H3600_BATT_STATUS_LOW          0x02
-+#define H3600_BATT_STATUS_CRITICAL     0x04
-+#define H3600_BATT_STATUS_CHARGING     0x08
-+#define H3600_BATT_STATUS_CHARGEMAIN   0x10
-+#define H3600_BATT_STATUS_DEAD         0x20 /* Battery will not charge */
-+#define H3600_BATT_STATUS_NOTINSTALLED 0x20 /* For expansion pack batteries */
-+#define H3600_BATT_STATUS_FULL         0x40 /* Battery fully charged (and connected to AC) */
-+#define H3600_BATT_STATUS_NOBATTERY    0x80
-+#define H3600_BATT_STATUS_UNKNOWN      0xff
-+
-+
-+//static struct power_supply_dev *micro_battery;
-+
-+static micro_private_t *p_micro;
-+
-+struct timer_list batt_timer;
-+
-+struct {
-+       int ac;
-+       int update_time;
-+       int chemistry;
-+       int voltage;
-+       int temperature;
-+       int flag;
-+} micro_battery;
-+
-+static void micro_battery_receive (int len, unsigned char *data) {
-+       if (0) {
-+               printk(KERN_ERR "h3600_battery - AC = %02x\n", data[0]);
-+               printk(KERN_ERR "h3600_battery - BAT1 chemistry = %02x\n", data[1]);
-+               printk(KERN_ERR "h3600_battery - BAT1 voltage = %d %02x%02x\n", (data[3]<<8)+data[2], data[2], data[3]);
-+               printk(KERN_ERR "h3600_battery - BAT1 status = %02x\n", data[4]);
-+       }
-+
-+       micro_battery.ac = data[0];
-+       micro_battery.chemistry = data[1];
-+       micro_battery.voltage = ((((unsigned short)data[3]<<8)+data[2]) * 5000L ) * 1000 / 1024;
-+       micro_battery.flag = data[4];
-+
-+       if (len == 9) {
-+               if (0) {
-+                       printk(KERN_ERR "h3600_battery - BAT2 chemistry = %02x\n", data[5]);
-+                       printk(KERN_ERR "h3600_battery - BAT2 voltage = %d %02x%02x\n", (data[7]<<8)+data[6], data[6], data[7]);
-+                       printk(KERN_ERR "h3600_battery - BAT2 status = %02x\n", data[8]);
-+               }
-+       }
-+}
-+
-+static void micro_temperature_receive (int len, unsigned char *data) {
-+       micro_battery.temperature = ((unsigned short)data[1]<<8)+data[0];
-+}
-+
-+void h3600_battery_read_status(unsigned long data) {
-+
-+       if (++data % 2)
-+               h3600_micro_tx_msg(0x09,0,NULL);
-+       else
-+               h3600_micro_tx_msg(0x06,0,NULL);
-+
-+       batt_timer.expires += BATT_PERIOD;
-+       batt_timer.data = data;
-+
-+       add_timer(&batt_timer);
-+}
-+
-+int get_capacity(struct power_supply *b) {
-+    switch (micro_battery.flag) {
-+    case H3600_BATT_STATUS_HIGH :     return 100; break;
-+    case H3600_BATT_STATUS_LOW :      return 50; break;
-+    case H3600_BATT_STATUS_CRITICAL : return 5; break;
-+    default: break;
-+    }
-+    return 0;
-+}
-+
-+int get_status(struct power_supply *b) {
-+
-+   if (micro_battery.flag == H3600_BATT_STATUS_UNKNOWN)
-+      return POWER_SUPPLY_STATUS_UNKNOWN;
-+
-+   if (micro_battery.flag & H3600_BATT_STATUS_FULL)
-+      return POWER_SUPPLY_STATUS_FULL;
-+
-+   if ((micro_battery.flag & H3600_BATT_STATUS_CHARGING) ||
-+       (micro_battery.flag & H3600_BATT_STATUS_CHARGEMAIN))
-+      return POWER_SUPPLY_STATUS_CHARGING;
-+
-+   return POWER_SUPPLY_STATUS_DISCHARGING;
-+}
-+
-+static int micro_batt_get_property(struct power_supply *b,
-+                                   enum power_supply_property psp,
-+                                   union power_supply_propval *val)
-+{
-+       switch (psp) {
-+       case POWER_SUPPLY_PROP_STATUS:
-+               val->intval = get_status(b);
-+               break;
-+       case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN:
-+               val->intval = 4700000;
-+               break;
-+       case POWER_SUPPLY_PROP_CAPACITY:
-+               val->intval = get_capacity(b);
-+               break;
-+       case POWER_SUPPLY_PROP_TEMP:
-+               val->intval = micro_battery.temperature;
-+               break;
-+       case POWER_SUPPLY_PROP_VOLTAGE_NOW:
-+               val->intval = micro_battery.voltage;
-+               break;
-+       default:
-+               return -EINVAL;
-+       };
-+
-+       return 0;
-+}
-+
-+static enum power_supply_property micro_batt_props[] = {
-+       POWER_SUPPLY_PROP_STATUS,
-+       POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN,
-+       POWER_SUPPLY_PROP_CAPACITY,
-+       POWER_SUPPLY_PROP_TEMP,
-+       POWER_SUPPLY_PROP_VOLTAGE_NOW,
-+};
-+
-+static struct power_supply h3600_battery = {
-+       .name               = "main-battery",
-+       .properties         = micro_batt_props,
-+       .num_properties     = ARRAY_SIZE(micro_batt_props),
-+       .get_property       = micro_batt_get_property,
-+       .use_for_apm        = 1,
-+};
-+
-+static int micro_batt_probe (struct platform_device *pdev)
-+{
-+       if (1) printk(KERN_ERR "micro battery probe : begin\n");
-+
-+       power_supply_register(&pdev->dev, &h3600_battery);
-+
-+       { /*--- callback ---*/
-+               p_micro = platform_get_drvdata(pdev);
-+               spin_lock(p_micro->lock);
-+               p_micro->h_batt = micro_battery_receive;
-+               p_micro->h_temp = micro_temperature_receive;
-+               spin_unlock(p_micro->lock);
-+       }
-+
-+       { /*--- timer ---*/
-+               init_timer(&batt_timer);
-+               batt_timer.expires = jiffies + BATT_PERIOD;
-+               batt_timer.data = 0;
-+               batt_timer.function = h3600_battery_read_status;
-+
-+               add_timer(&batt_timer);
-+       }
-+
-+       if (1) printk(KERN_ERR "micro battery probe : end\n");
-+       return 0;
-+}
-+
-+static int micro_batt_remove (struct platform_device *pdev)
-+{
-+       power_supply_unregister(&h3600_battery);
-+       { /*--- callback ---*/
-+               init_timer(&batt_timer);
-+               p_micro->h_batt = NULL;
-+               p_micro->h_temp = NULL;
-+               spin_unlock(p_micro->lock);
-+       }
-+       { /*--- timer ---*/
-+               del_timer_sync(&batt_timer);
-+       }
-+        return 0;
-+}
-+
-+static int micro_batt_suspend ( struct platform_device *pdev, pm_message_t state)
-+{
-+       { /*--- timer ---*/
-+               del_timer(&batt_timer);
-+       }
-+       return 0;
-+}
-+
-+static int micro_batt_resume ( struct platform_device *pdev)
-+{
-+       { /*--- timer ---*/
-+               add_timer(&batt_timer);
-+       }
-+       return 0;
-+}
-+
-+struct platform_driver micro_batt_device_driver = {
-+       .driver  = {
-+               .name    = "h3600-micro-battery",
-+       },
-+       .probe   = micro_batt_probe,
-+       .remove  = micro_batt_remove,
-+       .suspend = micro_batt_suspend,
-+       .resume  = micro_batt_resume,
-+};
-+
-+static int micro_batt_init (void)
-+{
-+       return platform_driver_register(&micro_batt_device_driver);
-+}
-+
-+static void micro_batt_cleanup (void)
-+{
-+       platform_driver_unregister (&micro_batt_device_driver);
-+}
-+
-+module_init (micro_batt_init);
-+module_exit (micro_batt_cleanup);
-+
-+MODULE_LICENSE("GPL");
-+MODULE_AUTHOR("gremlin.it");
-+MODULE_DESCRIPTION("driver for iPAQ Atmel micro battery");
-+
-+
-Index: linux-2.6.22/drivers/power/olpc_battery.c
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/olpc_battery.c   2007-08-23 12:13:52.000000000 +0200
-@@ -0,0 +1,302 @@
-+/*
-+ * Battery driver for One Laptop Per Child board.
-+ *
-+ *     Copyright © 2006  David Woodhouse <dwmw2@infradead.org>
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+
-+#include <linux/module.h>
-+#include <linux/err.h>
-+#include <linux/platform_device.h>
-+#include <linux/power_supply.h>
-+#include <linux/jiffies.h>
-+#include <linux/sched.h>
-+#include <asm/io.h>
-+
-+#define wBAT_VOLTAGE     0xf900  /* *9.76/32,    mV   */
-+#define wBAT_CURRENT     0xf902  /* *15.625/120, mA   */
-+#define wBAT_TEMP        0xf906  /* *256/1000,   °C  */
-+#define wAMB_TEMP        0xf908  /* *256/1000,   °C  */
-+#define SOC              0xf910  /* percentage        */
-+#define sMBAT_STATUS     0xfaa4
-+#define sBAT_PRESENT          1
-+#define sBAT_FULL             2
-+#define sBAT_DESTROY          4  /* what is this exactly? */
-+#define sBAT_LOW             32
-+#define sBAT_DISCHG          64
-+#define sMCHARGE_STATUS  0xfaa5
-+#define sBAT_CHARGE           1
-+#define sBAT_OVERTEMP         4
-+#define sBAT_NiMH             8
-+#define sPOWER_FLAG      0xfa40
-+#define ADAPTER_IN            1
-+
-+/*********************************************************************
-+ *             EC locking and access
-+ *********************************************************************/
-+
-+static int lock_ec(void)
-+{
-+       unsigned long timeo = jiffies + HZ / 20;
-+
-+       while (1) {
-+               unsigned char lock = inb(0x6c) & 0x80;
-+               if (!lock)
-+                       return 0;
-+               if (time_after(jiffies, timeo)) {
-+                       printk(KERN_ERR "olpc_battery: failed to lock EC for "
-+                              "battery access\n");
-+                       return 1;
-+               }
-+               yield();
-+       }
-+}
-+
-+static void unlock_ec(void)
-+{
-+       outb(0xff, 0x6c);
-+       return;
-+}
-+
-+static unsigned char read_ec_byte(unsigned short adr)
-+{
-+       outb(adr >> 8, 0x381);
-+       outb(adr, 0x382);
-+       return inb(0x383);
-+}
-+
-+static unsigned short read_ec_word(unsigned short adr)
-+{
-+       return (read_ec_byte(adr) << 8) | read_ec_byte(adr + 1);
-+}
-+
-+/*********************************************************************
-+ *             Power
-+ *********************************************************************/
-+
-+static int olpc_ac_get_prop(struct power_supply *psy,
-+                            enum power_supply_property psp,
-+                            union power_supply_propval *val)
-+{
-+       int ret = 0;
-+
-+       if (lock_ec())
-+               return -EIO;
-+
-+       switch (psp) {
-+       case POWER_SUPPLY_PROP_ONLINE:
-+               if (!(read_ec_byte(sMBAT_STATUS) & sBAT_PRESENT)) {
-+                       ret = -ENODEV;
-+                       goto out;
-+               }
-+               val->intval = !!(read_ec_byte(sPOWER_FLAG) & ADAPTER_IN);
-+               break;
-+       default:
-+               ret = -EINVAL;
-+               break;
-+       }
-+out:
-+       unlock_ec();
-+       return ret;
-+}
-+
-+static enum power_supply_property olpc_ac_props[] = {
-+       POWER_SUPPLY_PROP_ONLINE,
-+};
-+
-+static struct power_supply olpc_ac = {
-+       .name = "olpc-ac",
-+       .type = POWER_SUPPLY_TYPE_MAINS,
-+       .properties = olpc_ac_props,
-+       .num_properties = ARRAY_SIZE(olpc_ac_props),
-+       .get_property = olpc_ac_get_prop,
-+};
-+
-+/*********************************************************************
-+ *             Battery properties
-+ *********************************************************************/
-+
-+static int olpc_bat_get_property(struct power_supply *psy,
-+                                 enum power_supply_property psp,
-+                                 union power_supply_propval *val)
-+{
-+       int ret = 0;
-+
-+       if (lock_ec())
-+               return -EIO;
-+
-+       switch (psp) {
-+       case POWER_SUPPLY_PROP_STATUS:
-+               {
-+                       int status = POWER_SUPPLY_STATUS_UNKNOWN;
-+
-+                       val->intval = read_ec_byte(sMBAT_STATUS);
-+
-+                       if (!(val->intval & sBAT_PRESENT)) {
-+                               ret = -ENODEV;
-+                               goto out;
-+                       }
-+
-+                       if (val->intval & sBAT_DISCHG)
-+                               status = POWER_SUPPLY_STATUS_DISCHARGING;
-+                       else if (val->intval & sBAT_FULL)
-+                               status = POWER_SUPPLY_STATUS_FULL;
-+
-+                       val->intval = read_ec_byte(sMCHARGE_STATUS);
-+                       if (val->intval & sBAT_CHARGE)
-+                               status = POWER_SUPPLY_STATUS_CHARGING;
-+
-+                       val->intval = status;
-+                       break;
-+               }
-+       case POWER_SUPPLY_PROP_PRESENT:
-+               val->intval = !!(read_ec_byte(sMBAT_STATUS) & sBAT_PRESENT);
-+               break;
-+       case POWER_SUPPLY_PROP_HEALTH:
-+               val->intval = read_ec_byte(sMCHARGE_STATUS);
-+               if (val->intval & sBAT_OVERTEMP)
-+                       val->intval = POWER_SUPPLY_HEALTH_OVERHEAT;
-+               else
-+                       val->intval = POWER_SUPPLY_HEALTH_GOOD;
-+               break;
-+       case POWER_SUPPLY_PROP_TECHNOLOGY:
-+               val->intval = read_ec_byte(sMCHARGE_STATUS);
-+               if (val->intval & sBAT_NiMH)
-+                       val->intval = POWER_SUPPLY_TECHNOLOGY_NIMH;
-+               else
-+                       val->intval = POWER_SUPPLY_TECHNOLOGY_UNKNOWN;
-+               break;
-+       case POWER_SUPPLY_PROP_VOLTAGE_AVG:
-+               val->intval = read_ec_byte(wBAT_VOLTAGE) * 9760L / 32;
-+               break;
-+       case POWER_SUPPLY_PROP_CURRENT_AVG:
-+               val->intval = read_ec_byte(wBAT_CURRENT) * 15625L / 120;
-+               break;
-+       case POWER_SUPPLY_PROP_CAPACITY:
-+               val->intval = read_ec_byte(SOC);
-+               break;
-+       case POWER_SUPPLY_PROP_CAPACITY_LEVEL:
-+               val->intval = read_ec_byte(sMBAT_STATUS);
-+               if (val->intval & sBAT_FULL)
-+                       val->intval = POWER_SUPPLY_CAPACITY_LEVEL_FULL;
-+               else if (val->intval & sBAT_LOW)
-+                       val->intval = POWER_SUPPLY_CAPACITY_LEVEL_LOW;
-+               else
-+                       val->intval = POWER_SUPPLY_CAPACITY_LEVEL_NORMAL;
-+               break;
-+       case POWER_SUPPLY_PROP_TEMP:
-+               val->intval = read_ec_byte(wBAT_TEMP) * 256 / 100;
-+               break;
-+       case POWER_SUPPLY_PROP_TEMP_AMBIENT:
-+               val->intval = read_ec_byte(wAMB_TEMP) * 256 / 100;
-+               break;
-+       default:
-+               ret = -EINVAL;
-+               break;
-+       }
-+
-+out:
-+       unlock_ec();
-+       return ret;
-+}
-+
-+static enum power_supply_property olpc_bat_props[] = {
-+       POWER_SUPPLY_PROP_STATUS,
-+       POWER_SUPPLY_PROP_PRESENT,
-+       POWER_SUPPLY_PROP_HEALTH,
-+       POWER_SUPPLY_PROP_TECHNOLOGY,
-+       POWER_SUPPLY_PROP_VOLTAGE_AVG,
-+       POWER_SUPPLY_PROP_CURRENT_AVG,
-+       POWER_SUPPLY_PROP_CAPACITY,
-+       POWER_SUPPLY_PROP_CAPACITY_LEVEL,
-+       POWER_SUPPLY_PROP_TEMP,
-+       POWER_SUPPLY_PROP_TEMP_AMBIENT,
-+};
-+
-+/*********************************************************************
-+ *             Initialisation
-+ *********************************************************************/
-+
-+static struct platform_device *bat_pdev;
-+
-+static struct power_supply olpc_bat = {
-+       .properties = olpc_bat_props,
-+       .num_properties = ARRAY_SIZE(olpc_bat_props),
-+       .get_property = olpc_bat_get_property,
-+       .use_for_apm = 1,
-+};
-+
-+static int __init olpc_bat_init(void)
-+{
-+       int ret = 0;
-+       unsigned short tmp;
-+
-+       if (!request_region(0x380, 4, "olpc-battery")) {
-+               ret = -EIO;
-+               goto region_failed;
-+       }
-+
-+       if (lock_ec()) {
-+               ret = -EIO;
-+               goto lock_failed;
-+       }
-+
-+       tmp = read_ec_word(0xfe92);
-+       unlock_ec();
-+
-+       if (tmp != 0x380) {
-+               /* Doesn't look like OLPC EC */
-+               ret = -ENODEV;
-+               goto not_olpc_ec;
-+       }
-+
-+       bat_pdev = platform_device_register_simple("olpc-battery", 0, NULL, 0);
-+       if (IS_ERR(bat_pdev)) {
-+               ret = PTR_ERR(bat_pdev);
-+               goto pdev_failed;
-+       }
-+
-+       ret = power_supply_register(&bat_pdev->dev, &olpc_ac);
-+       if (ret)
-+               goto ac_failed;
-+
-+       olpc_bat.name = bat_pdev->name;
-+
-+       ret = power_supply_register(&bat_pdev->dev, &olpc_bat);
-+       if (ret)
-+               goto battery_failed;
-+
-+       goto success;
-+
-+battery_failed:
-+       power_supply_unregister(&olpc_ac);
-+ac_failed:
-+       platform_device_unregister(bat_pdev);
-+pdev_failed:
-+not_olpc_ec:
-+lock_failed:
-+       release_region(0x380, 4);
-+region_failed:
-+success:
-+       return ret;
-+}
-+
-+static void __exit olpc_bat_exit(void)
-+{
-+       power_supply_unregister(&olpc_bat);
-+       power_supply_unregister(&olpc_ac);
-+       platform_device_unregister(bat_pdev);
-+       release_region(0x380, 4);
-+       return;
-+}
-+
-+module_init(olpc_bat_init);
-+module_exit(olpc_bat_exit);
-+
-+MODULE_AUTHOR("David Woodhouse <dwmw2@infradead.org>");
-+MODULE_LICENSE("GPL");
-+MODULE_DESCRIPTION("Battery driver for One Laptop Per Child "
-+                   "($100 laptop) board.");
-Index: linux-2.6.22/drivers/power/pda_power.c
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/pda_power.c      2007-08-23 12:13:52.000000000 +0200
-@@ -0,0 +1,263 @@
-+/*
-+ * Common power driver for PDAs and phones with one or two external
-+ * power supplies (AC/USB) connected to main and backup batteries,
-+ * and optional builtin charger.
-+ *
-+ * Copyright 2007 Anton Vorontsov <cbou@mail.ru>
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+
-+#include <linux/module.h>
-+#include <linux/platform_device.h>
-+#include <linux/interrupt.h>
-+#include <linux/power_supply.h>
-+#include <linux/pda_power.h>
-+#include <linux/timer.h>
-+#include <linux/jiffies.h>
-+
-+static inline unsigned int get_irq_flags(struct resource *res)
-+{
-+       unsigned int flags = IRQF_DISABLED | IRQF_SHARED;
-+
-+       flags |= res->flags & IRQF_TRIGGER_MASK;
-+
-+       return flags;
-+}
-+
-+static struct device *dev;
-+static struct pda_power_pdata *pdata;
-+static struct resource *ac_irq, *usb_irq;
-+static struct timer_list charger_timer;
-+static struct timer_list supply_timer;
-+
-+static int pda_power_get_property(struct power_supply *psy,
-+                                  enum power_supply_property psp,
-+                                  union power_supply_propval *val)
-+{
-+       switch (psp) {
-+       case POWER_SUPPLY_PROP_ONLINE:
-+               if (psy->type == POWER_SUPPLY_TYPE_MAINS)
-+                       val->intval = pdata->is_ac_online ?
-+                                     pdata->is_ac_online() : 0;
-+               else
-+                       val->intval = pdata->is_usb_online ?
-+                                     pdata->is_usb_online() : 0;
-+               break;
-+       default:
-+               return -EINVAL;
-+       }
-+       return 0;
-+}
-+
-+static enum power_supply_property pda_power_props[] = {
-+       POWER_SUPPLY_PROP_ONLINE,
-+};
-+
-+static char *pda_power_supplied_to[] = {
-+       "main-battery",
-+       "backup-battery",
-+};
-+
-+static struct power_supply pda_power_supplies[] = {
-+       {
-+               .name = "ac",
-+               .type = POWER_SUPPLY_TYPE_MAINS,
-+               .supplied_to = pda_power_supplied_to,
-+               .num_supplicants = ARRAY_SIZE(pda_power_supplied_to),
-+               .properties = pda_power_props,
-+               .num_properties = ARRAY_SIZE(pda_power_props),
-+               .get_property = pda_power_get_property,
-+       },
-+       {
-+               .name = "usb",
-+               .type = POWER_SUPPLY_TYPE_USB,
-+               .supplied_to = pda_power_supplied_to,
-+               .num_supplicants = ARRAY_SIZE(pda_power_supplied_to),
-+               .properties = pda_power_props,
-+               .num_properties = ARRAY_SIZE(pda_power_props),
-+               .get_property = pda_power_get_property,
-+       },
-+};
-+
-+static void update_charger(void)
-+{
-+       if (!pdata->set_charge)
-+               return;
-+
-+       if (pdata->is_ac_online && pdata->is_ac_online()) {
-+               dev_dbg(dev, "charger on (AC)\n");
-+               pdata->set_charge(PDA_POWER_CHARGE_AC);
-+       }
-+       else if (pdata->is_usb_online && pdata->is_usb_online()) {
-+               dev_dbg(dev, "charger on (USB)\n");
-+               pdata->set_charge(PDA_POWER_CHARGE_USB);
-+       }
-+       else {
-+               dev_dbg(dev, "charger off\n");
-+               pdata->set_charge(0);
-+       }
-+
-+       return;
-+}
-+
-+static void supply_timer_func(unsigned long irq)
-+{
-+       if (ac_irq && irq == ac_irq->start)
-+               power_supply_changed(&pda_power_supplies[0]);
-+       else if (usb_irq && irq == usb_irq->start)
-+               power_supply_changed(&pda_power_supplies[1]);
-+       return;
-+}
-+
-+static void charger_timer_func(unsigned long irq)
-+{
-+       update_charger();
-+
-+       /* Okay, charger set. Now wait a bit before notifying supplicants,
-+        * charge power should stabilize. */
-+       supply_timer.data = irq;
-+       mod_timer(&supply_timer,
-+                 jiffies + msecs_to_jiffies(pdata->wait_for_charger));
-+       return;
-+}
-+
-+static irqreturn_t power_changed_isr(int irq, void *unused)
-+{
-+       /* Wait a bit before reading ac/usb line status and setting charger,
-+        * because ac/usb status readings may lag from irq. */
-+       charger_timer.data = irq;
-+       mod_timer(&charger_timer,
-+                 jiffies + msecs_to_jiffies(pdata->wait_for_status));
-+       return IRQ_HANDLED;
-+}
-+
-+static int pda_power_probe(struct platform_device *pdev)
-+{
-+       int ret = 0;
-+
-+       dev = &pdev->dev;
-+
-+       if (pdev->id != -1) {
-+               dev_err(dev, "it's meaningless to register several "
-+                       "pda_powers, use id = -1\n");
-+               ret = -EINVAL;
-+               goto wrongid;
-+       }
-+
-+       pdata = pdev->dev.platform_data;
-+
-+       update_charger();
-+
-+       if (!pdata->wait_for_status)
-+               pdata->wait_for_status = 500;
-+
-+       if (!pdata->wait_for_charger)
-+               pdata->wait_for_charger = 500;
-+
-+       setup_timer(&charger_timer, charger_timer_func, 0);
-+       setup_timer(&supply_timer, supply_timer_func, 0);
-+
-+       ac_irq = platform_get_resource_byname(pdev, IORESOURCE_IRQ, "ac");
-+       usb_irq = platform_get_resource_byname(pdev, IORESOURCE_IRQ, "usb");
-+       if (!ac_irq && !usb_irq) {
-+               dev_err(dev, "no ac/usb irq specified\n");
-+               ret = -ENODEV;
-+               goto noirqs;
-+       }
-+
-+       if (pdata->supplied_to) {
-+               pda_power_supplies[0].supplied_to = pdata->supplied_to;
-+               pda_power_supplies[1].supplied_to = pdata->supplied_to;
-+               pda_power_supplies[0].num_supplicants = pdata->num_supplicants;
-+               pda_power_supplies[1].num_supplicants = pdata->num_supplicants;
-+       }
-+
-+       ret = power_supply_register(&pdev->dev, &pda_power_supplies[0]);
-+       if (ret) {
-+               dev_err(dev, "failed to register %s power supply\n",
-+                       pda_power_supplies[0].name);
-+               goto supply0_failed;
-+       }
-+
-+       ret = power_supply_register(&pdev->dev, &pda_power_supplies[1]);
-+       if (ret) {
-+               dev_err(dev, "failed to register %s power supply\n",
-+                       pda_power_supplies[1].name);
-+               goto supply1_failed;
-+       }
-+
-+       if (ac_irq) {
-+               ret = request_irq(ac_irq->start, power_changed_isr,
-+                                 get_irq_flags(ac_irq), ac_irq->name,
-+                                 &pda_power_supplies[0]);
-+               if (ret) {
-+                       dev_err(dev, "request ac irq failed\n");
-+                       goto ac_irq_failed;
-+               }
-+       }
-+
-+       if (usb_irq) {
-+               ret = request_irq(usb_irq->start, power_changed_isr,
-+                                 get_irq_flags(usb_irq), usb_irq->name,
-+                                 &pda_power_supplies[1]);
-+               if (ret) {
-+                       dev_err(dev, "request usb irq failed\n");
-+                       goto usb_irq_failed;
-+               }
-+       }
-+
-+       goto success;
-+
-+usb_irq_failed:
-+       if (ac_irq)
-+               free_irq(ac_irq->start, &pda_power_supplies[0]);
-+ac_irq_failed:
-+       power_supply_unregister(&pda_power_supplies[1]);
-+supply1_failed:
-+       power_supply_unregister(&pda_power_supplies[0]);
-+supply0_failed:
-+noirqs:
-+wrongid:
-+success:
-+       return ret;
-+}
-+
-+static int pda_power_remove(struct platform_device *pdev)
-+{
-+       if (usb_irq)
-+               free_irq(usb_irq->start, &pda_power_supplies[1]);
-+       if (ac_irq)
-+               free_irq(ac_irq->start, &pda_power_supplies[0]);
-+       del_timer_sync(&charger_timer);
-+       del_timer_sync(&supply_timer);
-+       power_supply_unregister(&pda_power_supplies[1]);
-+       power_supply_unregister(&pda_power_supplies[0]);
-+       return 0;
-+}
-+
-+static struct platform_driver pda_power_pdrv = {
-+       .driver = {
-+               .name = "pda-power",
-+       },
-+       .probe = pda_power_probe,
-+       .remove = pda_power_remove,
-+};
-+
-+static int __init pda_power_init(void)
-+{
-+       return platform_driver_register(&pda_power_pdrv);
-+}
-+
-+static void __exit pda_power_exit(void)
-+{
-+       platform_driver_unregister(&pda_power_pdrv);
-+       return;
-+}
-+
-+module_init(pda_power_init);
-+module_exit(pda_power_exit);
-+MODULE_LICENSE("GPL");
-+MODULE_AUTHOR("Anton Vorontsov <cbou@mail.ru>");
-Index: linux-2.6.22/drivers/power/pmu_battery.c
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/pmu_battery.c    2007-08-23 12:13:52.000000000 +0200
-@@ -0,0 +1,215 @@
-+/*
-+ * Battery class driver for Apple PMU
-+ *
-+ *     Copyright © 2006  David Woodhouse <dwmw2@infradead.org>
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+
-+#include <linux/module.h>
-+#include <linux/platform_device.h>
-+#include <linux/err.h>
-+#include <linux/power_supply.h>
-+#include <linux/adb.h>
-+#include <linux/pmu.h>
-+
-+static struct pmu_battery_dev {
-+       struct power_supply bat;
-+       struct pmu_battery_info *pbi;
-+       char name[16];
-+       int propval;
-+} *pbats[PMU_MAX_BATTERIES];
-+
-+#define to_pmu_battery_dev(x) container_of(x, struct pmu_battery_dev, bat)
-+
-+/*********************************************************************
-+ *             Power
-+ *********************************************************************/
-+
-+static int pmu_get_ac_prop(struct power_supply *psy,
-+                           enum power_supply_property psp,
-+                           union power_supply_propval *val)
-+{
-+       switch (psp) {
-+       case POWER_SUPPLY_PROP_ONLINE:
-+               val->intval = (!!(pmu_power_flags & PMU_PWR_AC_PRESENT)) ||
-+                             (pmu_battery_count == 0);
-+               break;
-+       default:
-+               return -EINVAL;
-+       }
-+
-+       return 0;
-+}
-+
-+static enum power_supply_property pmu_ac_props[] = {
-+       POWER_SUPPLY_PROP_ONLINE,
-+};
-+
-+static struct power_supply pmu_ac = {
-+       .name = "pmu-ac",
-+       .type = POWER_SUPPLY_TYPE_MAINS,
-+       .properties = pmu_ac_props,
-+       .num_properties = ARRAY_SIZE(pmu_ac_props),
-+       .get_property = pmu_get_ac_prop,
-+};
-+
-+/*********************************************************************
-+ *             Battery properties
-+ *********************************************************************/
-+
-+static char *pmu_batt_types[] = {
-+       "Smart", "Comet", "Hooper", "Unknown"
-+};
-+
-+static char *pmu_bat_get_model_name(struct pmu_battery_info *pbi)
-+{
-+       switch (pbi->flags & PMU_BATT_TYPE_MASK) {
-+       case PMU_BATT_TYPE_SMART:
-+               return pmu_batt_types[0];
-+       case PMU_BATT_TYPE_COMET:
-+               return pmu_batt_types[1];
-+       case PMU_BATT_TYPE_HOOPER:
-+               return pmu_batt_types[2];
-+       default: break;
-+       }
-+       return pmu_batt_types[3];
-+}
-+
-+static int pmu_bat_get_property(struct power_supply *psy,
-+                                enum power_supply_property psp,
-+                                union power_supply_propval *val)
-+{
-+       struct pmu_battery_dev *pbat = to_pmu_battery_dev(psy);
-+       struct pmu_battery_info *pbi = pbat->pbi;
-+
-+       switch (psp) {
-+       case POWER_SUPPLY_PROP_STATUS:
-+               if (pbi->flags & PMU_BATT_CHARGING)
-+                       val->intval = POWER_SUPPLY_STATUS_CHARGING;
-+               else
-+                       val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
-+               break;
-+       case POWER_SUPPLY_PROP_PRESENT:
-+               val->intval = !!(pbi->flags & PMU_BATT_PRESENT);
-+               break;
-+       case POWER_SUPPLY_PROP_MODEL_NAME:
-+               val->strval = pmu_bat_get_model_name(pbi);
-+               break;
-+       case POWER_SUPPLY_PROP_ENERGY_AVG:
-+               val->intval = pbi->charge     * 1000; /* mWh -> µWh */
-+               break;
-+       case POWER_SUPPLY_PROP_ENERGY_FULL:
-+               val->intval = pbi->max_charge * 1000; /* mWh -> µWh */
-+               break;
-+       case POWER_SUPPLY_PROP_CURRENT_AVG:
-+               val->intval = pbi->amperage   * 1000; /* mA -> µA */
-+               break;
-+       case POWER_SUPPLY_PROP_VOLTAGE_AVG:
-+               val->intval = pbi->voltage    * 1000; /* mV -> µV */
-+               break;
-+       case POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG:
-+               val->intval = pbi->time_remaining;
-+               break;
-+       default:
-+               return -EINVAL;
-+       }
-+
-+       return 0;
-+}
-+
-+static enum power_supply_property pmu_bat_props[] = {
-+       POWER_SUPPLY_PROP_STATUS,
-+       POWER_SUPPLY_PROP_PRESENT,
-+       POWER_SUPPLY_PROP_MODEL_NAME,
-+       POWER_SUPPLY_PROP_ENERGY_AVG,
-+       POWER_SUPPLY_PROP_ENERGY_FULL,
-+       POWER_SUPPLY_PROP_CURRENT_AVG,
-+       POWER_SUPPLY_PROP_VOLTAGE_AVG,
-+       POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG,
-+};
-+
-+/*********************************************************************
-+ *             Initialisation
-+ *********************************************************************/
-+
-+static struct platform_device *bat_pdev;
-+
-+static int __init pmu_bat_init(void)
-+{
-+       int ret;
-+       int i;
-+
-+       bat_pdev = platform_device_register_simple("pmu-battery",
-+                                                  0, NULL, 0);
-+       if (IS_ERR(bat_pdev)) {
-+               ret = PTR_ERR(bat_pdev);
-+               goto pdev_register_failed;
-+       }
-+
-+       ret = power_supply_register(&bat_pdev->dev, &pmu_ac);
-+       if (ret)
-+               goto ac_register_failed;
-+
-+       for (i = 0; i < pmu_battery_count; i++) {
-+               struct pmu_battery_dev *pbat = kzalloc(sizeof(*pbat),
-+                                                      GFP_KERNEL);
-+               if (!pbat)
-+                       break;
-+
-+               sprintf(pbat->name, "PMU battery %d", i);
-+               pbat->bat.name = pbat->name;
-+               pbat->bat.properties = pmu_bat_props;
-+               pbat->bat.num_properties = ARRAY_SIZE(pmu_bat_props);
-+               pbat->bat.get_property = pmu_bat_get_property;
-+               pbat->pbi = &pmu_batteries[i];
-+
-+               ret = power_supply_register(&bat_pdev->dev, &pbat->bat);
-+               if (ret) {
-+                       kfree(pbat);
-+                       goto battery_register_failed;
-+               }
-+               pbats[i] = pbat;
-+       }
-+
-+       goto success;
-+
-+battery_register_failed:
-+       while (i--) {
-+               if (!pbats[i])
-+                       continue;
-+               power_supply_unregister(&pbats[i]->bat);
-+               kfree(pbats[i]);
-+       }
-+       power_supply_unregister(&pmu_ac);
-+ac_register_failed:
-+       platform_device_unregister(bat_pdev);
-+pdev_register_failed:
-+success:
-+       return ret;
-+}
-+
-+static void __exit pmu_bat_exit(void)
-+{
-+       int i;
-+
-+       for (i = 0; i < PMU_MAX_BATTERIES; i++) {
-+               if (!pbats[i])
-+                       continue;
-+               power_supply_unregister(&pbats[i]->bat);
-+               kfree(pbats[i]);
-+       }
-+       power_supply_unregister(&pmu_ac);
-+       platform_device_unregister(bat_pdev);
-+
-+       return;
-+}
-+
-+module_init(pmu_bat_init);
-+module_exit(pmu_bat_exit);
-+
-+MODULE_AUTHOR("David Woodhouse <dwmw2@infradead.org>");
-+MODULE_LICENSE("GPL");
-+MODULE_DESCRIPTION("PMU battery driver");
-Index: linux-2.6.22/drivers/power/power_supply_core.c
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/power_supply_core.c      2007-08-23 12:13:52.000000000 +0200
-@@ -0,0 +1,168 @@
-+/*
-+ *  Universal power supply monitor class
-+ *
-+ *  Copyright (c) 2007  Anton Vorontsov <cbou@mail.ru>
-+ *  Copyright (c) 2004  Szabolcs Gyurko
-+ *  Copyright (c) 2003  Ian Molton <spyro@f2s.com>
-+ *
-+ *  Modified: 2004, Oct     Szabolcs Gyurko
-+ *
-+ *  You may use this code as per GPL version 2
-+ */
-+
-+#include <linux/module.h>
-+#include <linux/types.h>
-+#include <linux/init.h>
-+#include <linux/device.h>
-+#include <linux/err.h>
-+#include <linux/power_supply.h>
-+#include "power_supply.h"
-+
-+struct class *power_supply_class;
-+
-+static void power_supply_changed_work(struct work_struct *work)
-+{
-+       struct power_supply *psy = container_of(work, struct power_supply,
-+                                               changed_work);
-+       int i;
-+
-+       dev_dbg(psy->dev, "%s\n", __FUNCTION__);
-+
-+       for (i = 0; i < psy->num_supplicants; i++) {
-+               struct device *dev;
-+
-+               down(&power_supply_class->sem);
-+               list_for_each_entry(dev, &power_supply_class->devices, node) {
-+                       struct power_supply *pst = dev_get_drvdata(dev);
-+
-+                       if (!strcmp(psy->supplied_to[i], pst->name)) {
-+                               if (pst->external_power_changed)
-+                                       pst->external_power_changed(pst);
-+                       }
-+               }
-+               up(&power_supply_class->sem);
-+       }
-+
-+       power_supply_update_leds(psy);
-+
-+       kobject_uevent(&psy->dev->kobj, KOBJ_CHANGE);
-+
-+       return;
-+}
-+
-+void power_supply_changed(struct power_supply *psy)
-+{
-+       dev_dbg(psy->dev, "%s\n", __FUNCTION__);
-+
-+       schedule_work(&psy->changed_work);
-+
-+       return;
-+}
-+
-+int power_supply_am_i_supplied(struct power_supply *psy)
-+{
-+       union power_supply_propval ret = {0,};
-+       struct device *dev;
-+
-+       down(&power_supply_class->sem);
-+       list_for_each_entry(dev, &power_supply_class->devices, node) {
-+               struct power_supply *epsy = dev_get_drvdata(dev);
-+               int i;
-+
-+               for (i = 0; i < epsy->num_supplicants; i++) {
-+                       if (!strcmp(epsy->supplied_to[i], psy->name)) {
-+                               if (epsy->get_property(epsy,
-+                                         POWER_SUPPLY_PROP_ONLINE, &ret))
-+                                       continue;
-+                               if (ret.intval)
-+                                       goto out;
-+                       }
-+               }
-+       }
-+out:
-+       up(&power_supply_class->sem);
-+
-+       dev_dbg(psy->dev, "%s %d\n", __FUNCTION__, ret.intval);
-+
-+       return ret.intval;
-+}
-+
-+int power_supply_register(struct device *parent, struct power_supply *psy)
-+{
-+       int rc = 0;
-+
-+       psy->dev = device_create(power_supply_class, parent, 0,
-+                                "%s", psy->name);
-+       if (IS_ERR(psy->dev)) {
-+               rc = PTR_ERR(psy->dev);
-+               goto dev_create_failed;
-+       }
-+
-+       dev_set_drvdata(psy->dev, psy);
-+
-+       INIT_WORK(&psy->changed_work, power_supply_changed_work);
-+
-+       rc = power_supply_create_attrs(psy);
-+       if (rc)
-+               goto create_attrs_failed;
-+
-+       rc = power_supply_create_triggers(psy);
-+       if (rc)
-+               goto create_triggers_failed;
-+
-+       power_supply_changed(psy);
-+
-+       goto success;
-+
-+create_triggers_failed:
-+       power_supply_remove_attrs(psy);
-+create_attrs_failed:
-+       device_unregister(psy->dev);
-+dev_create_failed:
-+success:
-+       return rc;
-+}
-+
-+void power_supply_unregister(struct power_supply *psy)
-+{
-+       flush_scheduled_work();
-+       power_supply_remove_triggers(psy);
-+       power_supply_remove_attrs(psy);
-+       device_unregister(psy->dev);
-+       return;
-+}
-+
-+static int __init power_supply_class_init(void)
-+{
-+       power_supply_class = class_create(THIS_MODULE, "power_supply");
-+
-+       if (IS_ERR(power_supply_class))
-+               return PTR_ERR(power_supply_class);
-+
-+       power_supply_class->dev_uevent = power_supply_uevent;
-+
-+       return 0;
-+}
-+
-+static void __exit power_supply_class_exit(void)
-+{
-+       class_destroy(power_supply_class);
-+       return;
-+}
-+
-+EXPORT_SYMBOL_GPL(power_supply_changed);
-+EXPORT_SYMBOL_GPL(power_supply_am_i_supplied);
-+EXPORT_SYMBOL_GPL(power_supply_register);
-+EXPORT_SYMBOL_GPL(power_supply_unregister);
-+
-+/* exported for the APM Power driver, APM emulation */
-+EXPORT_SYMBOL_GPL(power_supply_class);
-+
-+subsys_initcall(power_supply_class_init);
-+module_exit(power_supply_class_exit);
-+
-+MODULE_DESCRIPTION("Universal power supply monitor class");
-+MODULE_AUTHOR("Ian Molton <spyro@f2s.com>, "
-+              "Szabolcs Gyurko, "
-+              "Anton Vorontsov <cbou@mail.ru>");
-+MODULE_LICENSE("GPL");
-Index: linux-2.6.22/drivers/power/power_supply.h
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/power_supply.h   2007-08-23 12:13:52.000000000 +0200
-@@ -0,0 +1,42 @@
-+/*
-+ *  Functions private to power supply class
-+ *
-+ *  Copyright (c) 2007  Anton Vorontsov <cbou@mail.ru>
-+ *  Copyright (c) 2004  Szabolcs Gyurko
-+ *  Copyright (c) 2003  Ian Molton <spyro@f2s.com>
-+ *
-+ *  Modified: 2004, Oct     Szabolcs Gyurko
-+ *
-+ *  You may use this code as per GPL version 2
-+ */
-+
-+#ifdef CONFIG_SYSFS
-+
-+extern int power_supply_create_attrs(struct power_supply *psy);
-+extern void power_supply_remove_attrs(struct power_supply *psy);
-+extern int power_supply_uevent(struct device *dev, char **envp, int num_envp,
-+                               char *buffer, int buffer_size);
-+
-+#else
-+
-+static inline int power_supply_create_attrs(struct power_supply *psy)
-+{ return 0; }
-+static inline void power_supply_remove_attrs(struct power_supply *psy) {}
-+#define power_supply_uevent NULL
-+
-+#endif /* CONFIG_SYSFS */
-+
-+#ifdef CONFIG_LEDS_TRIGGERS
-+
-+extern void power_supply_update_leds(struct power_supply *psy);
-+extern int power_supply_create_triggers(struct power_supply *psy);
-+extern void power_supply_remove_triggers(struct power_supply *psy);
-+
-+#else
-+
-+static inline void power_supply_update_leds(struct power_supply *psy) {}
-+static inline int power_supply_create_triggers(struct power_supply *psy)
-+{ return 0; }
-+static inline void power_supply_remove_triggers(struct power_supply *psy) {}
-+
-+#endif /* CONFIG_LEDS_TRIGGERS */
-Index: linux-2.6.22/drivers/power/power_supply_leds.c
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/power_supply_leds.c      2007-08-23 12:13:52.000000000 +0200
-@@ -0,0 +1,188 @@
-+/*
-+ *  LEDs triggers for power supply class
-+ *
-+ *  Copyright (c) 2007  Anton Vorontsov <cbou@mail.ru>
-+ *  Copyright (c) 2004  Szabolcs Gyurko
-+ *  Copyright (c) 2003  Ian Molton <spyro@f2s.com>
-+ *
-+ *  Modified: 2004, Oct     Szabolcs Gyurko
-+ *
-+ *  You may use this code as per GPL version 2
-+ */
-+
-+#include <linux/power_supply.h>
-+
-+/* If we have hwtimer trigger, then use it to blink charging LED */
-+
-+#if defined(CONFIG_LEDS_TRIGGER_HWTIMER) ||                  \
-+               (defined(CONFIG_BATTERY_MODULE) &&            \
-+                defined(CONFIG_LEDS_TRIGGER_HWTIMER_MODULE))
-+       #define led_trigger_register_charging led_trigger_register_hwtimer
-+       #define led_trigger_unregister_charging led_trigger_unregister_hwtimer
-+#else
-+       #define led_trigger_register_charging led_trigger_register_simple
-+       #define led_trigger_unregister_charging led_trigger_unregister_simple
-+#endif
-+
-+/* Battery specific LEDs triggers. */
-+
-+static void power_supply_update_bat_leds(struct power_supply *psy)
-+{
-+       union power_supply_propval status;
-+
-+       if (psy->get_property(psy, POWER_SUPPLY_PROP_STATUS, &status))
-+               return;
-+
-+       dev_dbg(psy->dev, "%s %d\n", __FUNCTION__, status.intval);
-+
-+       switch(status.intval) {
-+       case POWER_SUPPLY_STATUS_FULL:
-+               led_trigger_event(psy->charging_full_trig, LED_FULL);
-+               led_trigger_event(psy->charging_trig, LED_OFF);
-+               led_trigger_event(psy->full_trig, LED_FULL);
-+               break;
-+       case POWER_SUPPLY_STATUS_CHARGING:
-+               led_trigger_event(psy->charging_full_trig, LED_FULL);
-+               led_trigger_event(psy->charging_trig, LED_FULL);
-+               led_trigger_event(psy->full_trig, LED_OFF);
-+               break;
-+       default:
-+               led_trigger_event(psy->charging_full_trig, LED_OFF);
-+               led_trigger_event(psy->charging_trig, LED_OFF);
-+               led_trigger_event(psy->full_trig, LED_OFF);
-+               break;
-+       }
-+
-+       return;
-+}
-+
-+static int power_supply_create_bat_triggers(struct power_supply *psy)
-+{
-+       int rc = 0;
-+
-+       psy->charging_full_trig_name = kmalloc(strlen(psy->name) +
-+                                 sizeof("-charging-or-full"), GFP_KERNEL);
-+       if (!psy->charging_full_trig_name)
-+               goto charging_full_failed;
-+
-+       psy->charging_trig_name = kmalloc(strlen(psy->name) +
-+                                         sizeof("-charging"), GFP_KERNEL);
-+       if (!psy->charging_trig_name)
-+               goto charging_failed;
-+
-+       psy->full_trig_name = kmalloc(strlen(psy->name) +
-+                                     sizeof("-full"), GFP_KERNEL);
-+       if (!psy->full_trig_name)
-+               goto full_failed;
-+
-+       strcpy(psy->charging_full_trig_name, psy->name);
-+       strcat(psy->charging_full_trig_name, "-charging-or-full");
-+       strcpy(psy->charging_trig_name, psy->name);
-+       strcat(psy->charging_trig_name, "-charging");
-+       strcpy(psy->full_trig_name, psy->name);
-+       strcat(psy->full_trig_name, "-full");
-+
-+       led_trigger_register_simple(psy->charging_full_trig_name,
-+                                   &psy->charging_full_trig);
-+       led_trigger_register_charging(psy->charging_trig_name,
-+                                     &psy->charging_trig);
-+       led_trigger_register_simple(psy->full_trig_name,
-+                                   &psy->full_trig);
-+
-+       goto success;
-+
-+full_failed:
-+       kfree(psy->charging_trig_name);
-+charging_failed:
-+       kfree(psy->charging_full_trig_name);
-+charging_full_failed:
-+       rc = -ENOMEM;
-+success:
-+       return rc;
-+}
-+
-+static void power_supply_remove_bat_triggers(struct power_supply *psy)
-+{
-+       led_trigger_unregister_simple(psy->charging_full_trig);
-+       led_trigger_unregister_charging(psy->charging_trig);
-+       led_trigger_unregister_simple(psy->full_trig);
-+       kfree(psy->full_trig_name);
-+       kfree(psy->charging_trig_name);
-+       kfree(psy->charging_full_trig_name);
-+       return;
-+}
-+
-+/* Generated power specific LEDs triggers. */
-+
-+static void power_supply_update_gen_leds(struct power_supply *psy)
-+{
-+       union power_supply_propval online;
-+
-+       if (psy->get_property(psy, POWER_SUPPLY_PROP_ONLINE, &online))
-+               return;
-+
-+       dev_dbg(psy->dev, "%s %d\n", __FUNCTION__, online.intval);
-+
-+       if (online.intval)
-+               led_trigger_event(psy->online_trig, LED_FULL);
-+       else
-+               led_trigger_event(psy->online_trig, LED_OFF);
-+
-+       return;
-+}
-+
-+static int power_supply_create_gen_triggers(struct power_supply *psy)
-+{
-+       int rc = 0;
-+
-+       psy->online_trig_name = kmalloc(strlen(psy->name) + sizeof("-online"),
-+                                       GFP_KERNEL);
-+       if (!psy->online_trig_name)
-+               goto online_failed;
-+
-+       strcpy(psy->online_trig_name, psy->name);
-+       strcat(psy->online_trig_name, "-online");
-+
-+       led_trigger_register_simple(psy->online_trig_name, &psy->online_trig);
-+
-+       goto success;
-+
-+online_failed:
-+       rc = -ENOMEM;
-+success:
-+       return rc;
-+}
-+
-+static void power_supply_remove_gen_triggers(struct power_supply *psy)
-+{
-+       led_trigger_unregister_simple(psy->online_trig);
-+       kfree(psy->online_trig_name);
-+       return;
-+}
-+
-+/* Choice what triggers to create&update. */
-+
-+void power_supply_update_leds(struct power_supply *psy)
-+{
-+       if (psy->type == POWER_SUPPLY_TYPE_BATTERY)
-+               power_supply_update_bat_leds(psy);
-+       else
-+               power_supply_update_gen_leds(psy);
-+       return;
-+}
-+
-+int power_supply_create_triggers(struct power_supply *psy)
-+{
-+       if (psy->type == POWER_SUPPLY_TYPE_BATTERY)
-+               return power_supply_create_bat_triggers(psy);
-+       return power_supply_create_gen_triggers(psy);
-+}
-+
-+void power_supply_remove_triggers(struct power_supply *psy)
-+{
-+       if (psy->type == POWER_SUPPLY_TYPE_BATTERY)
-+               power_supply_remove_bat_triggers(psy);
-+       else
-+               power_supply_remove_gen_triggers(psy);
-+       return;
-+}
-Index: linux-2.6.22/drivers/power/power_supply_sysfs.c
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/power_supply_sysfs.c     2007-08-23 12:13:52.000000000 +0200
-@@ -0,0 +1,289 @@
-+/*
-+ *  Sysfs interface for the universal power supply monitor class
-+ *
-+ *  Copyright ©  2007  David Woodhouse <dwmw2@infradead.org>
-+ *  Copyright (c) 2007  Anton Vorontsov <cbou@mail.ru>
-+ *  Copyright (c) 2004  Szabolcs Gyurko
-+ *  Copyright (c) 2003  Ian Molton <spyro@f2s.com>
-+ *
-+ *  Modified: 2004, Oct     Szabolcs Gyurko
-+ *
-+ *  You may use this code as per GPL version 2
-+ */
-+
-+#include <linux/ctype.h>
-+#include <linux/power_supply.h>
-+
-+/*
-+ * This is because the name "current" breaks the device attr macro.
-+ * The "current" word resolvs to "(get_current())" so instead of
-+ * "current" "(get_current())" appears in the sysfs.
-+ *
-+ * The source of this definition is the device.h which calls __ATTR
-+ * macro in sysfs.h which calls the __stringify macro.
-+ *
-+ * Only modification that the name is not tried to be resolved
-+ * (as a macro let's say).
-+ */
-+
-+#define POWER_SUPPLY_ATTR(_name)                                        \
-+{                                                                       \
-+       .attr = { .name = #_name, .mode = 0444, .owner = THIS_MODULE }, \
-+       .show = power_supply_show_property,                             \
-+       .store = NULL,                                                  \
-+}
-+
-+static struct device_attribute power_supply_attrs[];
-+
-+static ssize_t power_supply_show_property(struct device *dev,
-+                                          struct device_attribute *attr,
-+                                          char *buf) {
-+       static char *status_text[] = {
-+               "Unknown", "Charging", "Discharging", "Not charging", "Full"
-+       };
-+       static char *health_text[] = {
-+               "Unknown", "Good", "Overheat", "Dead"
-+       };
-+       static char *technology_text[] = {
-+               "Unknown", "NiMH", "Li-ion", "Li-poly"
-+       };
-+       static char *capacity_level_text[] = {
-+               "Unknown", "Critical", "Low", "Normal", "High", "Full"
-+       };
-+       ssize_t ret;
-+       struct power_supply *psy = dev_get_drvdata(dev);
-+       const ptrdiff_t off = attr - power_supply_attrs;
-+       union power_supply_propval value;
-+
-+       ret = psy->get_property(psy, off, &value);
-+
-+       if (ret < 0) {
-+               dev_err(dev, "driver failed to report `%s' property\n",
-+                       attr->attr.name);
-+               return ret;
-+       }
-+
-+       if (off == POWER_SUPPLY_PROP_STATUS)
-+               return sprintf(buf, "%s\n", status_text[value.intval]);
-+       else if (off == POWER_SUPPLY_PROP_HEALTH)
-+               return sprintf(buf, "%s\n", health_text[value.intval]);
-+       else if (off == POWER_SUPPLY_PROP_TECHNOLOGY)
-+               return sprintf(buf, "%s\n", technology_text[value.intval]);
-+       else if (off == POWER_SUPPLY_PROP_CAPACITY_LEVEL)
-+               return sprintf(buf, "%s\n",
-+                              capacity_level_text[value.intval]);
-+       else if (off == POWER_SUPPLY_PROP_MODEL_NAME)
-+               return sprintf(buf, "%s\n", value.strval);
-+
-+       return sprintf(buf, "%d\n", value.intval);
-+}
-+
-+/* Must be in the same order as POWER_SUPPLY_PROP_* */
-+static struct device_attribute power_supply_attrs[] = {
-+       /* Properties of type `int' */
-+       POWER_SUPPLY_ATTR(status),
-+       POWER_SUPPLY_ATTR(health),
-+       POWER_SUPPLY_ATTR(present),
-+       POWER_SUPPLY_ATTR(online),
-+       POWER_SUPPLY_ATTR(technology),
-+       POWER_SUPPLY_ATTR(voltage_max_design),
-+       POWER_SUPPLY_ATTR(voltage_min_design),
-+       POWER_SUPPLY_ATTR(voltage_now),
-+       POWER_SUPPLY_ATTR(voltage_avg),
-+       POWER_SUPPLY_ATTR(current_now),
-+       POWER_SUPPLY_ATTR(current_avg),
-+       POWER_SUPPLY_ATTR(charge_full_design),
-+       POWER_SUPPLY_ATTR(charge_empty_design),
-+       POWER_SUPPLY_ATTR(charge_full),
-+       POWER_SUPPLY_ATTR(charge_empty),
-+       POWER_SUPPLY_ATTR(charge_now),
-+       POWER_SUPPLY_ATTR(charge_avg),
-+       POWER_SUPPLY_ATTR(energy_full_design),
-+       POWER_SUPPLY_ATTR(energy_empty_design),
-+       POWER_SUPPLY_ATTR(energy_full),
-+       POWER_SUPPLY_ATTR(energy_empty),
-+       POWER_SUPPLY_ATTR(energy_now),
-+       POWER_SUPPLY_ATTR(energy_avg),
-+       POWER_SUPPLY_ATTR(capacity),
-+       POWER_SUPPLY_ATTR(capacity_level),
-+       POWER_SUPPLY_ATTR(temp),
-+       POWER_SUPPLY_ATTR(temp_ambient),
-+       POWER_SUPPLY_ATTR(time_to_empty_now),
-+       POWER_SUPPLY_ATTR(time_to_empty_avg),
-+       POWER_SUPPLY_ATTR(time_to_full_now),
-+       POWER_SUPPLY_ATTR(time_to_full_avg),
-+       /* Properties of type `const char *' */
-+       POWER_SUPPLY_ATTR(model_name),
-+};
-+
-+static ssize_t power_supply_show_static_attrs(struct device *dev,
-+                                              struct device_attribute *attr,
-+                                              char *buf) {
-+       static char *type_text[] = { "Battery", "UPS", "Mains", "USB" };
-+       struct power_supply *psy = dev_get_drvdata(dev);
-+
-+       return sprintf(buf, "%s\n", type_text[psy->type]);
-+}
-+
-+static struct device_attribute power_supply_static_attrs[] = {
-+       __ATTR(type, 0444, power_supply_show_static_attrs, NULL),
-+};
-+
-+int power_supply_create_attrs(struct power_supply *psy)
-+{
-+       int rc = 0;
-+       int i, j;
-+
-+       for (i = 0; i < ARRAY_SIZE(power_supply_static_attrs); i++) {
-+               rc = device_create_file(psy->dev,
-+                           &power_supply_static_attrs[i]);
-+               if (rc)
-+                       goto statics_failed;
-+       }
-+
-+       for (j = 0; j < psy->num_properties; j++) {
-+               rc = device_create_file(psy->dev,
-+                           &power_supply_attrs[psy->properties[j]]);
-+               if (rc)
-+                       goto dynamics_failed;
-+       }
-+
-+       goto succeed;
-+
-+dynamics_failed:
-+       while (j--)
-+               device_remove_file(psy->dev,
-+                          &power_supply_attrs[psy->properties[j]]);
-+statics_failed:
-+       while (i--)
-+               device_remove_file(psy->dev,
-+                          &power_supply_static_attrs[psy->properties[i]]);
-+succeed:
-+       return rc;
-+}
-+
-+void power_supply_remove_attrs(struct power_supply *psy)
-+{
-+       int i;
-+
-+       for (i = 0; i < ARRAY_SIZE(power_supply_static_attrs); i++)
-+               device_remove_file(psy->dev,
-+                           &power_supply_static_attrs[i]);
-+
-+       for (i = 0; i < psy->num_properties; i++)
-+               device_remove_file(psy->dev,
-+                           &power_supply_attrs[psy->properties[i]]);
-+
-+       return;
-+}
-+
-+static char *kstruprdup(const char *str, gfp_t gfp)
-+{
-+       char *ret, *ustr;
-+
-+       ustr = ret = kmalloc(strlen(str) + 1, gfp);
-+
-+       if (!ret)
-+               return NULL;
-+
-+       while (*str)
-+               *ustr++ = toupper(*str++);
-+
-+       *ustr = 0;
-+
-+       return ret;
-+}
-+
-+int power_supply_uevent(struct device *dev, char **envp, int num_envp,
-+                        char *buffer, int buffer_size)
-+{
-+       struct power_supply *psy = dev_get_drvdata(dev);
-+       int i = 0, length = 0, ret = 0, j;
-+       char *prop_buf;
-+       char *attrname;
-+
-+       dev_dbg(dev, "uevent\n");
-+
-+       if (!psy) {
-+               dev_dbg(dev, "No power supply yet\n");
-+               return ret;
-+       }
-+
-+       dev_dbg(dev, "POWER_SUPPLY_NAME=%s\n", psy->name);
-+
-+       ret = add_uevent_var(envp, num_envp, &i, buffer, buffer_size,
-+                            &length, "POWER_SUPPLY_NAME=%s", psy->name);
-+       if (ret)
-+               return ret;
-+
-+       prop_buf = (char *)get_zeroed_page(GFP_KERNEL);
-+       if (!prop_buf)
-+               return -ENOMEM;
-+
-+       for (j = 0; j < ARRAY_SIZE(power_supply_static_attrs); j++) {
-+               struct device_attribute *attr;
-+               char *line;
-+
-+               attr = &power_supply_static_attrs[j];
-+
-+               ret = power_supply_show_static_attrs(dev, attr, prop_buf);
-+               if (ret < 0)
-+                       goto out;
-+
-+               line = strchr(prop_buf, '\n');
-+               if (line)
-+                       *line = 0;
-+
-+               attrname = kstruprdup(attr->attr.name, GFP_KERNEL);
-+               if (!attrname) {
-+                       ret = -ENOMEM;
-+                       goto out;
-+               }
-+
-+               dev_dbg(dev, "Static prop %s=%s\n", attrname, prop_buf);
-+
-+               ret = add_uevent_var(envp, num_envp, &i, buffer, buffer_size,
-+                                    &length, "POWER_SUPPLY_%s=%s",
-+                                    attrname, prop_buf);
-+               kfree(attrname);
-+               if (ret)
-+                       goto out;
-+       }
-+
-+       dev_dbg(dev, "%zd dynamic props\n", psy->num_properties);
-+
-+       for (j = 0; j < psy->num_properties; j++) {
-+               struct device_attribute *attr;
-+               char *line;
-+
-+               attr = &power_supply_attrs[psy->properties[j]];
-+
-+               ret = power_supply_show_property(dev, attr, prop_buf);
-+               if (ret < 0)
-+                       goto out;
-+
-+               line = strchr(prop_buf, '\n');
-+               if (line)
-+                       *line = 0;
-+
-+               attrname = kstruprdup(attr->attr.name, GFP_KERNEL);
-+               if (!attrname) {
-+                       ret = -ENOMEM;
-+                       goto out;
-+               }
-+
-+               dev_dbg(dev, "prop %s=%s\n", attrname, prop_buf);
-+
-+               ret = add_uevent_var(envp, num_envp, &i, buffer, buffer_size,
-+                                    &length, "POWER_SUPPLY_%s=%s",
-+                                    attrname, prop_buf);
-+               kfree(attrname);
-+               if (ret)
-+                       goto out;
-+       }
-+
-+out:
-+       free_page((unsigned long)prop_buf);
-+
-+       return ret;
-+}
-Index: linux-2.6.22/drivers/power/simpad-battery.c
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/simpad-battery.c 2007-08-23 12:13:52.000000000 +0200
-@@ -0,0 +1,242 @@
-+/*
-+ *  linux/drivers/misc/simpad-battery.c
-+ *
-+ *  Copyright (C) 2005 Holger Hans Peter Freyther
-+ *  Copyright (C) 2001 Juergen Messerer
-+ *
-+ * 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.
-+ *
-+ * Read the Battery Level through the UCB1x00 chip. T-Sinuspad is
-+ * unsupported for now.
-+ *
-+ */
-+
-+#include <linux/battery.h>
-+#include <asm/dma.h>
-+#include "ucb1x00.h"
-+
-+
-+/*
-+ * Conversion from AD -> mV
-+ * 7.5V = 1023   7.3313mV/Digit
-+ *
-+ * 400 Units == 9.7V
-+ * a     = ADC value
-+ * 21    = ADC error
-+ * 12600 = Divident to get 2*7.3242
-+ * 860   = Divider to get 2*7.3242
-+ * 170   = Voltagedrop over
-+ */
-+#define CALIBRATE_BATTERY(a)   ((((a + 21)*12600)/860) + 170)
-+
-+/*
-+ * We have two types of batteries a small and a large one
-+ * To get the right value we to distinguish between those two
-+ * 450 Units == 15 V
-+ */
-+#define CALIBRATE_SUPPLY(a)   (((a) * 1500) / 45)
-+#define MIN_SUPPLY            12000 /* Less then 12V means no powersupply */
-+
-+/*
-+ * Charging Current
-+ * if value is >= 50 then charging is on
-+ */
-+#define CALIBRATE_CHARGING(a)    (((a)* 1000)/(152/4)))
-+
-+struct simpad_battery_t {
-+       struct battery  battery;
-+       struct ucb1x00* ucb;
-+
-+        /*
-+        * Variables for the values to one time support
-+        * T-Sinuspad as well
-+        */
-+       int min_voltage;
-+       int min_current;
-+       int min_charge;
-+
-+       int max_voltage;
-+       int max_current;
-+       int max_charge;
-+
-+       int min_supply;
-+       int charging_led_label;
-+       int charging_max_label;
-+       int batt_full;
-+       int batt_low;
-+       int batt_critical;
-+       int batt_empty;
-+};
-+
-+static int simpad_get_min_voltage(struct battery* _battery )
-+{
-+       struct simpad_battery_t* battery = (struct simpad_battery_t*)_battery;
-+       return  battery->min_voltage;
-+}
-+
-+static int simpad_get_min_current(struct battery* _battery)
-+{
-+       struct simpad_battery_t* battery = (struct simpad_battery_t*)_battery;
-+       return battery->min_current;
-+}
-+
-+static int simpad_get_min_charge(struct battery* _battery)
-+{
-+       struct simpad_battery_t* battery = (struct simpad_battery_t*)_battery;
-+       return battery->min_charge;
-+}
-+
-+static int simpad_get_max_voltage(struct battery* _battery)
-+{
-+       struct simpad_battery_t* battery = (struct simpad_battery_t*)_battery;
-+       return battery->max_voltage;
-+}
-+
-+static int simpad_get_max_current(struct battery* _battery)
-+{
-+       struct simpad_battery_t* battery = (struct simpad_battery_t*)_battery;
-+       return battery->max_current;
-+}
-+
-+static int simpad_get_max_charge(struct battery* _battery)
-+{
-+       struct simpad_battery_t* battery = (struct simpad_battery_t*)_battery;
-+       return battery->max_charge;
-+}
-+
-+static int simpad_get_temp(struct battery* _battery)
-+{
-+       return 0;
-+}
-+
-+static int simpad_get_voltage(struct battery* _battery)
-+{
-+       int val;
-+       struct simpad_battery_t* battery = (struct simpad_battery_t*)_battery;
-+
-+
-+       ucb1x00_adc_enable(battery->ucb);
-+       val = ucb1x00_adc_read(battery->ucb, UCB_ADC_INP_AD1, UCB_NOSYNC);
-+       ucb1x00_adc_disable(battery->ucb);
-+
-+       return CALIBRATE_BATTERY(val);
-+}
-+
-+static int simpad_get_current(struct battery* _battery)
-+{
-+       int val;
-+       struct simpad_battery_t* battery = (struct simpad_battery_t*)_battery;
-+
-+       ucb1x00_adc_enable(battery->ucb);
-+       val = ucb1x00_adc_read(battery->ucb, UCB_ADC_INP_AD3, UCB_NOSYNC);
-+       ucb1x00_adc_disable(battery->ucb);
-+
-+       return val;
-+}
-+
-+static int simpad_get_charge(struct battery* _battery)
-+{
-+       int val;
-+       struct simpad_battery_t* battery = (struct simpad_battery_t*)_battery;
-+
-+       ucb1x00_adc_enable(battery->ucb);
-+       val = ucb1x00_adc_read(battery->ucb, UCB_ADC_INP_AD2, UCB_NOSYNC);
-+       ucb1x00_adc_disable(battery->ucb);
-+
-+       return CALIBRATE_SUPPLY(val);
-+
-+}
-+
-+static int simpad_get_status(struct battery* _battery)
-+{
-+       struct simpad_battery_t* battery = (struct simpad_battery_t*)(_battery);
-+       int vcharger = simpad_get_voltage(_battery);
-+       int icharger = simpad_get_current(_battery);
-+
-+       int status = BATTERY_STATUS_UNKNOWN;
-+       if(icharger > battery->charging_led_label)
-+               status = BATTERY_STATUS_CHARGING;
-+       else if(vcharger > battery->min_supply)
-+               status = BATTERY_STATUS_NOT_CHARGING;
-+       else
-+               status = BATTERY_STATUS_DISCHARGING;
-+
-+       return status;
-+}
-+
-+static struct simpad_battery_t simpad_battery  = {
-+       .battery = {
-+               .get_min_voltage = simpad_get_min_voltage,
-+               .get_min_current = simpad_get_min_current,
-+               .get_min_charge  = simpad_get_min_charge,
-+               .get_max_voltage = simpad_get_max_voltage,
-+               .get_max_current = simpad_get_max_current,
-+               .get_max_charge  = simpad_get_max_charge,
-+               .get_temp        = simpad_get_temp,
-+               .get_voltage     = simpad_get_voltage,
-+               .get_current     = simpad_get_current,
-+               .get_charge      = simpad_get_charge,
-+               .get_status      = simpad_get_status,
-+       },
-+       .min_voltage = 0,
-+       .min_current = 0,
-+       .min_charge  = 0,
-+       .max_voltage = 0,
-+       .max_current = 0,
-+       .max_charge  = 0,
-+
-+       .min_supply         = 1200,
-+       .charging_led_label = 18,
-+       .charging_max_label = 265,
-+       .batt_full          = 8300,
-+       .batt_low           = 7300,
-+       .batt_critical      = 6800,
-+       .batt_empty         = 6500,
-+};
-+
-+
-+
-+/*
-+ * UCB glue code
-+ */
-+static int ucb1x00_battery_add(struct class_device *dev)
-+{
-+       struct ucb1x00 *ucb = classdev_to_ucb1x00(dev);
-+       simpad_battery.ucb  = ucb;
-+
-+       battery_class_register(&simpad_battery.battery);
-+
-+       return 0;
-+}
-+
-+static void ucb1x00_battery_remove(struct class_device *dev)
-+{
-+       return battery_class_unregister(&simpad_battery.battery);
-+}
-+
-+
-+static struct ucb1x00_class_interface ucb1x00_battery_interface = {
-+       .interface   = {
-+               .add    = ucb1x00_battery_add,
-+               .remove = ucb1x00_battery_remove,
-+       },
-+};
-+
-+
-+static int __init battery_register(void)
-+{
-+       return ucb1x00_register_interface(&ucb1x00_battery_interface);
-+}
-+
-+static void __exit battery_unregister(void)
-+{
-+       ucb1x00_unregister_interface(&ucb1x00_battery_interface);
-+}
-+
-+module_init(battery_register);
-+module_exit(battery_unregister);
-+
-+MODULE_AUTHOR("Holger Hans Peter Freyther");
-+MODULE_LICENSE("GPL");
-Index: linux-2.6.22/arch/arm/Kconfig
-===================================================================
---- linux-2.6.22.orig/arch/arm/Kconfig  2007-08-23 12:17:42.000000000 +0200
-+++ linux-2.6.22/arch/arm/Kconfig       2007-08-23 12:22:28.000000000 +0200
-@@ -1016,6 +1016,8 @@
- 
- source "drivers/w1/Kconfig"
- 
-+source "drivers/power/Kconfig"
-+
- source "drivers/hwmon/Kconfig"
- 
- #source "drivers/l3/Kconfig"
-Index: linux-2.6.22/drivers/Kconfig
-===================================================================
---- linux-2.6.22.orig/drivers/Kconfig   2007-08-23 12:21:27.000000000 +0200
-+++ linux-2.6.22/drivers/Kconfig        2007-08-23 12:22:03.000000000 +0200
-@@ -54,6 +54,8 @@
- 
- source "drivers/w1/Kconfig"
- 
-+source "drivers/power/Kconfig"
-+
- source "drivers/hwmon/Kconfig"
- 
- source "drivers/mfd/Kconfig"
-Index: linux-2.6.22/drivers/Makefile
-===================================================================
---- linux-2.6.22.orig/drivers/Makefile  2007-08-23 12:33:58.000000000 +0200
-+++ linux-2.6.22/drivers/Makefile       2007-08-23 12:34:34.000000000 +0200
-@@ -61,6 +61,7 @@
- obj-$(CONFIG_RTC_LIB)          += rtc/
- obj-y                          += i2c/
- obj-$(CONFIG_W1)               += w1/
-+obj-$(CONFIG_POWER_SUPPLY)     += power/
- obj-$(CONFIG_HWMON)            += hwmon/
- obj-$(CONFIG_PHONE)            += telephony/
- obj-$(CONFIG_MD)               += md/
-Index: linux-2.6.22/include/linux/power_supply.h
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/include/linux/power_supply.h   2007-08-23 12:37:10.000000000 +0200
-@@ -0,0 +1,175 @@
-+/*
-+ *  Universal power supply monitor class
-+ *
-+ *  Copyright (c) 2007  Anton Vorontsov <cbou@mail.ru>
-+ *  Copyright (c) 2004  Szabolcs Gyurko
-+ *  Copyright (c) 2003  Ian Molton <spyro@f2s.com>
-+ *
-+ *  Modified: 2004, Oct     Szabolcs Gyurko
-+ *
-+ *  You may use this code as per GPL version 2
-+ */
-+
-+#ifndef __LINUX_POWER_SUPPLY_H__
-+#define __LINUX_POWER_SUPPLY_H__
-+
-+#include <linux/device.h>
-+#include <linux/workqueue.h>
-+#include <linux/leds.h>
-+
-+/*
-+ * All voltages, currents, charges, energies, time and temperatures in uV,
-+ * uA, uAh, uWh, seconds and tenths of degree Celsius unless otherwise
-+ * stated. It's driver's job to convert its raw values to units in which
-+ * this class operates.
-+ */
-+
-+/*
-+ * For systems where the charger determines the maximum battery capacity
-+ * the min and max fields should be used to present these values to user
-+ * space. Unused/unknown fields will not appear in sysfs.
-+ */
-+
-+enum {
-+       POWER_SUPPLY_STATUS_UNKNOWN = 0,
-+       POWER_SUPPLY_STATUS_CHARGING,
-+       POWER_SUPPLY_STATUS_DISCHARGING,
-+       POWER_SUPPLY_STATUS_NOT_CHARGING,
-+       POWER_SUPPLY_STATUS_FULL,
-+};
-+
-+enum {
-+       POWER_SUPPLY_HEALTH_UNKNOWN = 0,
-+       POWER_SUPPLY_HEALTH_GOOD,
-+       POWER_SUPPLY_HEALTH_OVERHEAT,
-+       POWER_SUPPLY_HEALTH_DEAD,
-+};
-+
-+enum {
-+       POWER_SUPPLY_TECHNOLOGY_UNKNOWN = 0,
-+       POWER_SUPPLY_TECHNOLOGY_NIMH,
-+       POWER_SUPPLY_TECHNOLOGY_LION,
-+       POWER_SUPPLY_TECHNOLOGY_LIPO,
-+};
-+
-+enum {
-+       POWER_SUPPLY_CAPACITY_LEVEL_UNKNOWN = 0,
-+       POWER_SUPPLY_CAPACITY_LEVEL_CRITICAL,
-+       POWER_SUPPLY_CAPACITY_LEVEL_LOW,
-+       POWER_SUPPLY_CAPACITY_LEVEL_NORMAL,
-+       POWER_SUPPLY_CAPACITY_LEVEL_HIGH,
-+       POWER_SUPPLY_CAPACITY_LEVEL_FULL,
-+};
-+
-+enum power_supply_property {
-+       /* Properties of type `int' */
-+       POWER_SUPPLY_PROP_STATUS = 0,
-+       POWER_SUPPLY_PROP_HEALTH,
-+       POWER_SUPPLY_PROP_PRESENT,
-+       POWER_SUPPLY_PROP_ONLINE,
-+       POWER_SUPPLY_PROP_TECHNOLOGY,
-+       POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN,
-+       POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN,
-+       POWER_SUPPLY_PROP_VOLTAGE_NOW,
-+       POWER_SUPPLY_PROP_VOLTAGE_AVG,
-+       POWER_SUPPLY_PROP_CURRENT_NOW,
-+       POWER_SUPPLY_PROP_CURRENT_AVG,
-+       POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN,
-+       POWER_SUPPLY_PROP_CHARGE_EMPTY_DESIGN,
-+       POWER_SUPPLY_PROP_CHARGE_FULL,
-+       POWER_SUPPLY_PROP_CHARGE_EMPTY,
-+       POWER_SUPPLY_PROP_CHARGE_NOW,
-+       POWER_SUPPLY_PROP_CHARGE_AVG,
-+       POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN,
-+       POWER_SUPPLY_PROP_ENERGY_EMPTY_DESIGN,
-+       POWER_SUPPLY_PROP_ENERGY_FULL,
-+       POWER_SUPPLY_PROP_ENERGY_EMPTY,
-+       POWER_SUPPLY_PROP_ENERGY_NOW,
-+       POWER_SUPPLY_PROP_ENERGY_AVG,
-+       POWER_SUPPLY_PROP_CAPACITY, /* in percents! */
-+       POWER_SUPPLY_PROP_CAPACITY_LEVEL,
-+       POWER_SUPPLY_PROP_TEMP,
-+       POWER_SUPPLY_PROP_TEMP_AMBIENT,
-+       POWER_SUPPLY_PROP_TIME_TO_EMPTY_NOW,
-+       POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG,
-+       POWER_SUPPLY_PROP_TIME_TO_FULL_NOW,
-+       POWER_SUPPLY_PROP_TIME_TO_FULL_AVG,
-+       /* Properties of type `const char *' */
-+       POWER_SUPPLY_PROP_MODEL_NAME,
-+};
-+
-+enum power_supply_type {
-+       POWER_SUPPLY_TYPE_BATTERY = 0,
-+       POWER_SUPPLY_TYPE_UPS,
-+       POWER_SUPPLY_TYPE_MAINS,
-+       POWER_SUPPLY_TYPE_USB,
-+};
-+
-+union power_supply_propval {
-+       int intval;
-+       const char *strval;
-+};
-+
-+struct power_supply {
-+       const char *name;
-+       enum power_supply_type type;
-+       enum power_supply_property *properties;
-+       size_t num_properties;
-+
-+       char **supplied_to;
-+       size_t num_supplicants;
-+
-+       int (*get_property)(struct power_supply *psy,
-+                           enum power_supply_property psp,
-+                           union power_supply_propval *val);
-+       void (*external_power_changed)(struct power_supply *psy);
-+
-+       /* For APM emulation, think legacy userspace. */
-+       int use_for_apm;
-+
-+       /* private */
-+       struct device *dev;
-+       struct work_struct changed_work;
-+
-+#ifdef CONFIG_LEDS_TRIGGERS
-+       struct led_trigger *charging_full_trig;
-+       char *charging_full_trig_name;
-+       struct led_trigger *charging_trig;
-+       char *charging_trig_name;
-+       struct led_trigger *full_trig;
-+       char *full_trig_name;
-+       struct led_trigger *online_trig;
-+       char *online_trig_name;
-+#endif
-+};
-+
-+/*
-+ * This is recommended structure to specify static power supply parameters.
-+ * Generic one, parametrizable for different power supplies. Power supply
-+ * class itself does not use it, but that's what implementing most platform
-+ * drivers, should try reuse for consistency.
-+ */
-+
-+struct power_supply_info {
-+       const char *name;
-+       int technology;
-+       int voltage_max_design;
-+       int voltage_min_design;
-+       int charge_full_design;
-+       int charge_empty_design;
-+       int energy_full_design;
-+       int energy_empty_design;
-+       int use_for_apm;
-+};
-+
-+extern void power_supply_changed(struct power_supply *psy);
-+extern int power_supply_am_i_supplied(struct power_supply *psy);
-+
-+extern int power_supply_register(struct device *parent,
-+                                 struct power_supply *psy);
-+extern void power_supply_unregister(struct power_supply *psy);
-+
-+/* For APM emulation, think legacy userspace. */
-+extern struct class *power_supply_class;
-+
-+#endif /* __LINUX_POWER_SUPPLY_H__ */
diff --git a/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/pxa27x_overlay-r8.patch b/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/pxa27x_overlay-r8.patch
deleted file mode 100644
index 693ad20453..0000000000
--- a/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/pxa27x_overlay-r8.patch
+++ /dev/null
@@ -1,2427 +0,0 @@
- drivers/video/Kconfig               |   18 
- drivers/video/Makefile              |    1 
- drivers/video/pxafb.c               |  305 +++++--
- drivers/video/pxafb.h               |   65 +
- drivers/video/pxafb_overlay.c       | 1525 ++++++++++++++++++++++++++++++++++++
- include/asm-arm/arch-pxa/pxa-regs.h |  111 ++
- 6 files changed, 1969 insertions(+), 56 deletions(-)
-
---- linux-2.6.24-rc1.orig/drivers/video/Kconfig
-+++ linux-2.6.24-rc1/drivers/video/Kconfig
-@@ -1718,6 +1718,24 @@
- 
-          If unsure, say N.
- 
-+choice
-+       prompt "PXA LCD type"
-+       depends on FB_PXA
-+
-+config FB_PXA_LCD_QVGA
-+        bool "QVGA(320x240)"
-+
-+config FB_PXA_LCD_VGA
-+        bool "VGA (640x480)"
-+
-+endchoice
-+
-+config FB_PXA_OVERLAY
-+    tristate "PXA LCD overlay support"
-+    depends on FB_PXA
-+    ---help---
-+        Frame buffer overlay driver for PXA27x
-+
- config FB_PXA_PARAMETERS
-        bool "PXA LCD command line parameters"
-        default n
---- linux-2.6.24-rc1.orig/drivers/video/Makefile
-+++ linux-2.6.24-rc1/drivers/video/Makefile
-@@ -96,6 +96,7 @@
- obj-$(CONFIG_FB_CIRRUS)                  += cirrusfb.o
- obj-$(CONFIG_FB_ASILIANT)        += asiliantfb.o
- obj-$(CONFIG_FB_PXA)             += pxafb.o
-+obj-$(CONFIG_FB_PXA_OVERLAY)     += pxafb_overlay.o
- obj-$(CONFIG_FB_W100)            += w100fb.o
- obj-$(CONFIG_FB_AU1100)                  += au1100fb.o
- obj-$(CONFIG_FB_AU1200)                  += au1200fb.o
---- linux-2.6.24-rc1.orig/drivers/video/pxafb.c
-+++ linux-2.6.24-rc1/drivers/video/pxafb.c
-@@ -59,17 +59,49 @@
- #define LCCR0_INVALID_CONFIG_MASK (LCCR0_OUM|LCCR0_BM|LCCR0_QDM|LCCR0_DIS|LCCR0_EFM|LCCR0_IUM|LCCR0_SFM|LCCR0_LDM|LCCR0_ENB)
- #define LCCR3_INVALID_CONFIG_MASK (LCCR3_HSP|LCCR3_VSP|LCCR3_PCD|LCCR3_BPP)
- 
-+wait_queue_head_t fcs_wait_eof;
-+int fcs_in_eof;
-+static DECLARE_MUTEX(fcs_lcd_sem);
-+
- static void (*pxafb_backlight_power)(int);
- static void (*pxafb_lcd_power)(int, struct fb_var_screeninfo *);
- 
- static int pxafb_activate_var(struct fb_var_screeninfo *var, struct pxafb_info *);
--static void set_ctrlr_state(struct pxafb_info *fbi, u_int state);
-+void pxafb_set_ctrlr_state(struct pxafb_info *fbi, u_int state);
- 
- #ifdef CONFIG_FB_PXA_PARAMETERS
- #define PXAFB_OPTIONS_SIZE 256
- static char g_options[PXAFB_OPTIONS_SIZE] __devinitdata = "";
- #endif
- 
-+static struct pxafb_rgb def_rgb_8 = {
-+       red:    { offset: 0,  length: 8, },
-+       green:  { offset: 0,  length: 8, },
-+       blue:   { offset: 0,  length: 8, },
-+       transp: { offset: 0,  length: 0, },
-+};
-+
-+static struct pxafb_rgb def_rgb_16 = {
-+       red:    { offset: 11, length: 5, },
-+       green:  { offset: 5,  length: 6, },
-+       blue:   { offset: 0,  length: 5, },
-+       transp: { offset: 0,  length: 0, },
-+};
-+
-+static struct pxafb_rgb def_rgb_18 = {
-+       red:    { offset: 12, length: 6, },
-+       green:  { offset: 6,  length: 6, },
-+       blue:   { offset: 0,  length: 6, },
-+       transp: { offset: 0,  length: 0, },
-+};
-+
-+static struct pxafb_rgb def_rgb_24 = {
-+       red:    { offset: 16, length: 8, },
-+       green:  { offset: 8,  length: 8, },
-+       blue:   { offset: 0,  length: 8, },
-+       transp: { offset: 0,  length: 0, },
-+};
-+
- static inline void pxafb_schedule_work(struct pxafb_info *fbi, u_int state)
- {
-        unsigned long flags;
-@@ -209,6 +241,10 @@
-         case 4:  ret = LCCR3_4BPP; break;
-         case 8:  ret = LCCR3_8BPP; break;
-         case 16: ret = LCCR3_16BPP; break;
-+        case 18: ret = LCCR3_18BPP; break;
-+        case 19: ret = LCCR3_19BPP; break;
-+        case 24: ret = LCCR3_24BPP; break;
-+        case 25: ret = LCCR3_25BPP; break;
-         }
-         return ret;
- }
-@@ -320,18 +356,34 @@
-         * The pixel packing format is described on page 7-11 of the
-         * PXA2XX Developer's Manual.
-          */
--       if (var->bits_per_pixel == 16) {
--               var->red.offset   = 11; var->red.length   = 5;
--               var->green.offset = 5;  var->green.length = 6;
--               var->blue.offset  = 0;  var->blue.length  = 5;
--               var->transp.offset = var->transp.length = 0;
--       } else {
--               var->red.offset = var->green.offset = var->blue.offset = var->transp.offset = 0;
--               var->red.length   = 8;
--               var->green.length = 8;
--               var->blue.length  = 8;
--               var->transp.length = 0;
--       }
-+       switch (var->bits_per_pixel) {
-+       case 16:
-+               /* 2 pixels per line */
-+               var->red    = def_rgb_16.red;
-+               var->green  = def_rgb_16.green;
-+               var->blue   = def_rgb_16.blue;
-+               var->transp = def_rgb_16.transp;
-+               break;
-+       case 18:
-+       case 19:
-+               var->red    = def_rgb_18.red;
-+               var->green  = def_rgb_18.green;
-+               var->blue   = def_rgb_18.blue;
-+               var->transp = def_rgb_18.transp;
-+               break;
-+       case 24:
-+       case 25:
-+               var->red    = def_rgb_24.red;
-+               var->green  = def_rgb_24.green;
-+               var->blue   = def_rgb_24.blue;
-+               var->transp = def_rgb_24.transp;
-+               break;
-+        default:
-+               var->red    = def_rgb_8.red;
-+               var->green  = def_rgb_8.green;
-+               var->blue   = def_rgb_8.blue;
-+               var->transp = def_rgb_8.transp;
-+    }
- 
- #ifdef CONFIG_CPU_FREQ
-        pr_debug("pxafb: dma period = %d ps, clock = %d kHz\n",
-@@ -345,7 +397,7 @@
- static inline void pxafb_set_truecolor(u_int is_true_color)
- {
-        pr_debug("pxafb: true_color = %d\n", is_true_color);
--       // do your machine-specific setup if needed
-+       /* do your machine-specific setup if needed */
- }
- 
- /*
-@@ -360,7 +412,8 @@
- 
-        pr_debug("pxafb: set_par\n");
- 
--       if (var->bits_per_pixel == 16)
-+       if (var->bits_per_pixel == 16 || var->bits_per_pixel == 18 ||var->bits_per_pixel == 19
-+        || var->bits_per_pixel == 24 || var->bits_per_pixel == 25)
-                fbi->fb.fix.visual = FB_VISUAL_TRUECOLOR;
-        else if (!fbi->cmap_static)
-                fbi->fb.fix.visual = FB_VISUAL_PSEUDOCOLOR;
-@@ -373,12 +426,25 @@
-                fbi->fb.fix.visual = FB_VISUAL_STATIC_PSEUDOCOLOR;
-        }
- 
--       fbi->fb.fix.line_length = var->xres_virtual *
--                                 var->bits_per_pixel / 8;
--       if (var->bits_per_pixel == 16)
--               fbi->palette_size = 0;
--       else
--               fbi->palette_size = var->bits_per_pixel == 1 ? 4 : 1 << var->bits_per_pixel;
-+       switch (var->bits_per_pixel) {
-+       case 16:
-+               fbi->fb.fix.line_length = var->xres_virtual * 2;
-+               fbi->palette_size = 0;
-+               break;
-+       case 18:
-+       case 19:
-+               fbi->fb.fix.line_length = var->xres_virtual * 3;
-+               fbi->palette_size = 0;
-+               break;
-+       case 24:
-+       case 25:
-+               fbi->fb.fix.line_length = var->xres_virtual * 4;
-+               fbi->palette_size = 0;
-+               break;
-+       default:
-+               fbi->fb.fix.line_length = var->xres_virtual * var->bits_per_pixel / 8;
-+               fbi->palette_size = var->bits_per_pixel == 1 ? 4 : 1 << var->bits_per_pixel;
-+       }
- 
-        if ((fbi->lccr4 & LCCR4_PAL_FOR_MASK) == LCCR4_PAL_FOR_0)
-                palette_mem_size = fbi->palette_size * sizeof(u16);
-@@ -395,7 +461,8 @@
-         */
-        pxafb_set_truecolor(fbi->fb.fix.visual == FB_VISUAL_TRUECOLOR);
- 
--       if (fbi->fb.var.bits_per_pixel == 16)
-+       if (fbi->fb.var.bits_per_pixel == 16 || fbi->fb.var.bits_per_pixel == 18 ||fbi->fb.var.bits_per_pixel == 19
-+        || fbi->fb.var.bits_per_pixel == 24 || fbi->fb.var.bits_per_pixel == 25)
-                fb_dealloc_cmap(&fbi->fb.cmap);
-        else
-                fb_alloc_cmap(&fbi->fb.cmap, 1<<fbi->fb.var.bits_per_pixel, 0);
-@@ -441,7 +508,7 @@
-  *     16 bpp mode does not really use the palette, so this will not
-  *      blank the display in all modes.
-  */
--static int pxafb_blank(int blank, struct fb_info *info)
-+int pxafb_blank(int blank, struct fb_info *info)
- {
-        struct pxafb_info *fbi = (struct pxafb_info *)info;
-        int i;
-@@ -458,19 +525,20 @@
-                        for (i = 0; i < fbi->palette_size; i++)
-                                pxafb_setpalettereg(i, 0, 0, 0, 0, info);
- 
--               pxafb_schedule_work(fbi, C_DISABLE);
--               //TODO if (pxafb_blank_helper) pxafb_blank_helper(blank);
-+               pxafb_schedule_work(fbi, C_BLANK);
-+               /* TODO if (pxafb_blank_helper) pxafb_blank_helper(blank); */
-                break;
- 
-        case FB_BLANK_UNBLANK:
--               //TODO if (pxafb_blank_helper) pxafb_blank_helper(blank);
-+               /* TODO if (pxafb_blank_helper) pxafb_blank_helper(blank); */
-                if (fbi->fb.fix.visual == FB_VISUAL_PSEUDOCOLOR ||
-                    fbi->fb.fix.visual == FB_VISUAL_STATIC_PSEUDOCOLOR)
-                        fb_set_cmap(&fbi->fb.cmap, info);
--               pxafb_schedule_work(fbi, C_ENABLE);
-+               pxafb_schedule_work(fbi, C_UNBLANK);
-        }
-        return 0;
- }
-+EXPORT_SYMBOL(pxafb_blank);
- 
- static int pxafb_mmap(struct fb_info *info,
-                      struct vm_area_struct *vma)
-@@ -606,6 +674,10 @@
-        case 4:
-        case 8:
-        case 16:
-+       case 18:
-+       case 19:
-+       case 24:
-+       case 25:
-                break;
-        default:
-                printk(KERN_ERR "%s: invalid bit depth %d\n",
-@@ -637,7 +709,10 @@
- 
-        new_regs.lccr0 = fbi->lccr0 |
-                (LCCR0_LDM | LCCR0_SFM | LCCR0_IUM | LCCR0_EFM |
--                 LCCR0_QDM | LCCR0_BM  | LCCR0_OUM);
-+#ifdef CONFIG_PXA27x   /* Enable overlay for PXA27x */
-+                LCCR0_OUC | LCCR0_CMDIM | LCCR0_RDSTM |
-+#endif
-+                 LCCR0_QDM | LCCR0_BM | LCCR0_OUM);
- 
-        new_regs.lccr1 =
-                LCCR1_DisWdth(var->xres) +
-@@ -696,7 +771,7 @@
- 
-        fbi->dmadesc_fbhigh_cpu->fsadr = fbi->screen_dma;
-        fbi->dmadesc_fbhigh_cpu->fidr = 0;
--       fbi->dmadesc_fbhigh_cpu->ldcmd = BYTES_PER_PANEL;
-+       fbi->dmadesc_fbhigh_cpu->ldcmd = BYTES_PER_PANEL | LDCMD_EOFINT;
- 
-        fbi->dmadesc_palette_cpu->fsadr = fbi->palette_dma;
-        fbi->dmadesc_palette_cpu->fidr  = 0;
-@@ -708,7 +783,8 @@
-                                                        sizeof(u32);
-        fbi->dmadesc_palette_cpu->ldcmd |= LDCMD_PAL;
- 
--       if (var->bits_per_pixel == 16) {
-+       if (var->bits_per_pixel == 16 || var->bits_per_pixel == 18 ||var->bits_per_pixel == 19
-+        || var->bits_per_pixel == 24 || var->bits_per_pixel == 25) {
-                /* palette shouldn't be loaded in true-color mode */
-                fbi->dmadesc_fbhigh_cpu->fdadr = fbi->dmadesc_fbhigh_dma;
-                fbi->fdadr0 = fbi->dmadesc_fbhigh_dma; /* no pal just fbhigh */
-@@ -763,8 +839,8 @@
- }
- 
- /*
-- * NOTE!  The following functions are purely helpers for set_ctrlr_state.
-- * Do not call them directly; set_ctrlr_state does the correct serialisation
-+ * NOTE!  The following functions are purely helpers for pxafb_set_ctrlr_state.
-+ * Do not call them directly; pxafb_set_ctrlr_state does the correct serialisation
-  * to ensure that things happen in the right way 100% of time time.
-  *     -- rmk
-  */
-@@ -786,7 +862,8 @@
- 
- static void pxafb_setup_gpio(struct pxafb_info *fbi)
- {
--       int gpio, ldd_bits;
-+       int gpio;
-+       int ldd_bits = 0;
-         unsigned int lccr0 = fbi->lccr0;
- 
-        /*
-@@ -796,28 +873,56 @@
-        /* 4 bit interface */
-        if ((lccr0 & LCCR0_CMS) == LCCR0_Mono &&
-            (lccr0 & LCCR0_SDS) == LCCR0_Sngl &&
--           (lccr0 & LCCR0_DPD) == LCCR0_4PixMono)
-+           (lccr0 & LCCR0_DPD) == LCCR0_4PixMono) {
-                ldd_bits = 4;
--
-+       }
-        /* 8 bit interface */
-         else if (((lccr0 & LCCR0_CMS) == LCCR0_Mono &&
-                  ((lccr0 & LCCR0_SDS) == LCCR0_Dual || (lccr0 & LCCR0_DPD) == LCCR0_8PixMono)) ||
-                  ((lccr0 & LCCR0_CMS) == LCCR0_Color &&
--                 (lccr0 & LCCR0_PAS) == LCCR0_Pas && (lccr0 & LCCR0_SDS) == LCCR0_Sngl))
-+                 (lccr0 & LCCR0_PAS) == LCCR0_Pas && (lccr0 & LCCR0_SDS) == LCCR0_Sngl)) {
-                ldd_bits = 8;
--
-+       }
-        /* 16 bit interface */
--       else if ((lccr0 & LCCR0_CMS) == LCCR0_Color &&
--                ((lccr0 & LCCR0_SDS) == LCCR0_Dual || (lccr0 & LCCR0_PAS) == LCCR0_Act))
--               ldd_bits = 16;
-+       else if ((lccr0 & LCCR0_CMS) == LCCR0_Color &&
-+               ((lccr0 & LCCR0_SDS) == LCCR0_Dual || (lccr0 & LCCR0_PAS) == LCCR0_Act)) {
-+               switch (fbi->fb.var.bits_per_pixel) {
-+               case 16:
-+#ifdef CONFIG_PXA27x
-+                       /* bits 58-77 */
-+                       GPDR1 |= (0x3f << 26);
-+                       GPDR2 |= 0x00003fff;
- 
-+                       GAFR1_U = (GAFR1_U & ~(0xfff << 20)) | (0xaaa << 20);
-+                       GAFR2_L = (GAFR2_L & 0xf0000000) | 0x0aaaaaaa;
-+#endif
-+                       ldd_bits = 16;
-+                       break;
-+               case 18:
-+               case 19:
-+               case 24:
-+               case 25:
-+#ifdef CONFIG_PXA27x
-+                       /* bits 58-77 and 86, 87 */
-+                       GPDR1 |= (0x3f << 26);
-+                       GPDR2 |= 0x00c03fff;
-+
-+                       GAFR1_U = (GAFR1_U & ~(0xfff << 20)) | (0xaaa << 20);
-+                       GAFR2_L = (GAFR2_L & 0xf0000000) | 0x0aaaaaaa;
-+                       GAFR2_U = (GAFR2_U & 0xffff0fff) | 0xa000;
-+#endif
-+                       ldd_bits = 25;
-+                       break;
-+               }
-+       }
-        else {
-                printk(KERN_ERR "pxafb_setup_gpio: unable to determine bits per pixel\n");
-                return;
-         }
- 
--       for (gpio = 58; ldd_bits; gpio++, ldd_bits--)
-+       for (gpio = 58; ldd_bits > 0; gpio++, ldd_bits--) {
-                pxa_gpio_mode(gpio | GPIO_ALT_FN_2_OUT);
-+       }
-        pxa_gpio_mode(GPIO74_LCD_FCLK_MD);
-        pxa_gpio_mode(GPIO75_LCD_LCLK_MD);
-        pxa_gpio_mode(GPIO76_LCD_PCLK_MD);
-@@ -837,6 +942,7 @@
-        /* enable LCD controller clock */
-        clk_enable(fbi->clk);
- 
-+       down(&fcs_lcd_sem);
-        /* Sequence from 11.7.10 */
-        LCCR3 = fbi->reg_lccr3;
-        LCCR2 = fbi->reg_lccr2;
-@@ -847,6 +953,8 @@
-        FDADR1 = fbi->fdadr1;
-        LCCR0 |= LCCR0_ENB;
- 
-+       up(&fcs_lcd_sem);
-+
-        pr_debug("FDADR0 0x%08x\n", (unsigned int) FDADR0);
-        pr_debug("FDADR1 0x%08x\n", (unsigned int) FDADR1);
-        pr_debug("LCCR0 0x%08x\n", (unsigned int) LCCR0);
-@@ -862,6 +970,7 @@
- 
-        pr_debug("pxafb: disabling LCD controller\n");
- 
-+       down(&fcs_lcd_sem);
-        set_current_state(TASK_UNINTERRUPTIBLE);
-        add_wait_queue(&fbi->ctrlr_wait, &wait);
- 
-@@ -871,6 +980,7 @@
- 
-        schedule_timeout(200 * HZ / 1000);
-        remove_wait_queue(&fbi->ctrlr_wait, &wait);
-+       up(&fcs_lcd_sem);
- 
-        /* disable LCD controller clock */
-        clk_disable(fbi->clk);
-@@ -888,6 +998,11 @@
-                LCCR0 |= LCCR0_LDM;
-                wake_up(&fbi->ctrlr_wait);
-        }
-+       if (lcsr & LCSR_EOF && fcs_in_eof) {
-+               LCCR0 |= LCCR0_EFM;
-+               fcs_in_eof = 0;
-+               wake_up(&fcs_wait_eof);
-+       }
- 
-        LCSR = lcsr;
-        return IRQ_HANDLED;
-@@ -898,7 +1013,7 @@
-  * sleep when disabling the LCD controller, or if we get two contending
-  * processes trying to alter state.
-  */
--static void set_ctrlr_state(struct pxafb_info *fbi, u_int state)
-+void pxafb_set_ctrlr_state(struct pxafb_info *fbi, u_int state)
- {
-        u_int old_state;
- 
-@@ -920,7 +1035,9 @@
-                 */
-                if (old_state != C_DISABLE && old_state != C_DISABLE_PM) {
-                        fbi->state = state;
--                       //TODO __pxafb_lcd_power(fbi, 0);
-+                       /* TODO __pxafb_lcd_power(fbi, 0); */
-+                       if(fbi->set_overlay_ctrlr_state)
-+                               fbi->set_overlay_ctrlr_state(fbi, C_DISABLE);
-                        pxafb_disable_controller(fbi);
-                }
-                break;
-@@ -934,6 +1051,8 @@
-                        fbi->state = state;
-                        __pxafb_backlight_power(fbi, 0);
-                        __pxafb_lcd_power(fbi, 0);
-+                       if(fbi->set_overlay_ctrlr_state)
-+                               fbi->set_overlay_ctrlr_state(fbi, C_DISABLE);
-                        if (old_state != C_DISABLE_CLKCHANGE)
-                                pxafb_disable_controller(fbi);
-                }
-@@ -947,7 +1066,9 @@
-                if (old_state == C_DISABLE_CLKCHANGE) {
-                        fbi->state = C_ENABLE;
-                        pxafb_enable_controller(fbi);
--                       //TODO __pxafb_lcd_power(fbi, 1);
-+                       /* TODO __pxafb_lcd_power(fbi, 1); */
-+                       if(fbi->set_overlay_ctrlr_state)
-+                               fbi->set_overlay_ctrlr_state(fbi, C_ENABLE);
-                }
-                break;
- 
-@@ -959,9 +1080,13 @@
-                 */
-                if (old_state == C_ENABLE) {
-                        __pxafb_lcd_power(fbi, 0);
-+                       if(fbi->set_overlay_ctrlr_state)
-+                               fbi->set_overlay_ctrlr_state(fbi, C_DISABLE);
-                        pxafb_disable_controller(fbi);
-                        pxafb_setup_gpio(fbi);
-                        pxafb_enable_controller(fbi);
-+                       if(fbi->set_overlay_ctrlr_state)
-+                               fbi->set_overlay_ctrlr_state(fbi, C_ENABLE);
-                        __pxafb_lcd_power(fbi, 1);
-                }
-                break;
-@@ -987,11 +1112,46 @@
-                        pxafb_enable_controller(fbi);
-                        __pxafb_lcd_power(fbi, 1);
-                        __pxafb_backlight_power(fbi, 1);
-+                       if(fbi->set_overlay_ctrlr_state)
-+                               fbi->set_overlay_ctrlr_state(fbi, C_ENABLE);
-                }
-                break;
-+
-+       case C_BLANK:
-+               /*
-+                * Disable controller, blank overlays if exist.
-+                */
-+               if ((old_state != C_DISABLE) && (old_state != C_BLANK)) {
-+                       fbi->state = state;
-+                       __pxafb_backlight_power(fbi, 0);
-+                       __pxafb_lcd_power(fbi, 0);
-+                       if(fbi->set_overlay_ctrlr_state)
-+                               fbi->set_overlay_ctrlr_state(fbi, C_BLANK);
-+                       if (old_state != C_DISABLE_CLKCHANGE)
-+                               pxafb_disable_controller(fbi);
-+               }
-+               break;
-+
-+       case C_UNBLANK:
-+               /*
-+                * Power up the LCD screen, enable controller, and
-+                * turn on the backlight, unblank overlays if exist.
-+                */
-+               if ((old_state != C_ENABLE) && (old_state != C_UNBLANK)) {
-+                       fbi->state = C_UNBLANK;
-+                       pxafb_setup_gpio(fbi);
-+                       pxafb_enable_controller(fbi);
-+                       __pxafb_lcd_power(fbi, 1);
-+                       __pxafb_backlight_power(fbi, 1);
-+                       if(fbi->set_overlay_ctrlr_state)
-+                               fbi->set_overlay_ctrlr_state(fbi, C_UNBLANK);
-+               }
-+               break;
-+
-        }
-        up(&fbi->ctrlr_sem);
- }
-+EXPORT_SYMBOL(pxafb_set_ctrlr_state);
- 
- /*
-  * Our LCD controller task (which is called when we blank or unblank)
-@@ -1003,7 +1163,7 @@
-                container_of(work, struct pxafb_info, task);
-        u_int state = xchg(&fbi->task_state, -1);
- 
--       set_ctrlr_state(fbi, state);
-+       pxafb_set_ctrlr_state(fbi, state);
- }
- 
- #ifdef CONFIG_CPU_FREQ
-@@ -1018,19 +1178,29 @@
- pxafb_freq_transition(struct notifier_block *nb, unsigned long val, void *data)
- {
-        struct pxafb_info *fbi = TO_INF(nb, freq_transition);
--       //TODO struct cpufreq_freqs *f = data;
-+       /* TODO struct cpufreq_freqs *f = data; */
-+       struct cpufreq_freqs *clkinfo;
-        u_int pcd;
-+       u_int lccr3;
- 
-        switch (val) {
-        case CPUFREQ_PRECHANGE:
--               set_ctrlr_state(fbi, C_DISABLE_CLKCHANGE);
-+               pxafb_set_ctrlr_state(fbi, C_DISABLE_CLKCHANGE);
-                break;
- 
-        case CPUFREQ_POSTCHANGE:
--               pcd = get_pcd(fbi, fbi->fb.var.pixclock);
-+               clkinfo = (struct cpufreq_freqs *)data;
-+               /* If leaving a 13kHz state with the LCD sustained */
-+               if ((clkinfo->old == 13000))
-+                       break;
-+
-+               pcd = get_pcd(fbi->fb.var.pixclock);
-+               lccr3 = fbi->reg_lccr3;
-                set_hsync_time(fbi, pcd);
-                fbi->reg_lccr3 = (fbi->reg_lccr3 & ~0xff) | LCCR3_PixClkDiv(pcd);
--               set_ctrlr_state(fbi, C_ENABLE_CLKCHANGE);
-+               pxafb_set_ctrlr_state(fbi, C_ENABLE_CLKCHANGE);
-+               if (lccr3 != fbi->reg_lccr3 && !((LCCR0 & LCCR0_DIS) || !(LCCR0 & LCCR0_ENB)))
-+                       LCCR3 = fbi->reg_lccr3;
-                break;
-        }
-        return 0;
-@@ -1049,7 +1219,7 @@
-                printk(KERN_DEBUG "min dma period: %d ps, "
-                        "new clock %d kHz\n", pxafb_display_dma_period(var),
-                        policy->max);
--               // TODO: fill in min/max values
-+               /* TODO: fill in min/max values */
-                break;
- #if 0
-        case CPUFREQ_NOTIFY:
-@@ -1075,7 +1245,7 @@
- {
-        struct pxafb_info *fbi = platform_get_drvdata(dev);
- 
--       set_ctrlr_state(fbi, C_DISABLE_PM);
-+       pxafb_set_ctrlr_state(fbi, C_DISABLE_PM);
-        return 0;
- }
- 
-@@ -1083,7 +1253,11 @@
- {
-        struct pxafb_info *fbi = platform_get_drvdata(dev);
- 
--       set_ctrlr_state(fbi, C_ENABLE_PM);
-+       pxafb_set_ctrlr_state(fbi, C_ENABLE_PM);
-+//RP#ifdef CONFIG_PXA27x
-+//RP   LCCR4 |= (1 << 31); /* Disable the PCD Divisor, PCDDIV */
-+//RP   LCCR4 |= (5 << 17); /* Undocumented feature */
-+//RP#endif
-        return 0;
- }
- #else
-@@ -1197,11 +1371,21 @@
-        fbi->task_state                 = (u_char)-1;
- 
-        for (i = 0; i < inf->num_modes; i++) {
--               smemlen = mode[i].xres * mode[i].yres * mode[i].bpp / 8;
-+               if (mode[i].bpp <= 16) {       /* 8, 16 bpp */
-+                       smemlen = mode[i].xres * mode[i].yres * mode[i].bpp / 8;
-+               } else if ( mode[i].bpp > 19 ) { /* 24, 25 bpp */
-+                       smemlen = mode[i].xres * mode[i].yres * 4;
-+               } else {                          /* 18, 19 bpp */
-+                       /* packed format */
-+                       smemlen = mode[i].xres * mode[i].yres * 3;
-+               }
-+
-                if (smemlen > fbi->fb.fix.smem_len)
-                        fbi->fb.fix.smem_len = smemlen;
-        }
- 
-+       fbi->set_overlay_ctrlr_state    = NULL;
-+
-        init_waitqueue_head(&fbi->ctrlr_wait);
-        INIT_WORK(&fbi->task, pxafb_task);
-        init_MUTEX(&fbi->ctrlr_sem);
-@@ -1268,6 +1452,10 @@
-                                case 4:
-                                case 8:
-                                case 16:
-+                               case 18:
-+                               case 19:
-+                               case 24:
-+                               case 25:
-                                        inf->modes[0].bpp = bpp;
-                                        dev_info(dev, "overriding bit depth: %d\n", bpp);
-                                        break;
-@@ -1416,7 +1604,7 @@
-        fbi = pxafb_init_fbinfo(&dev->dev);
-        if (!fbi) {
-                dev_err(&dev->dev, "Failed to initialize framebuffer device\n");
--               ret = -ENOMEM; // only reason for pxafb_init_fbinfo to fail is kmalloc
-+               ret = -ENOMEM; /* only reason for pxafb_init_fbinfo to fail is kmalloc */
-                goto failed;
-        }
- 
-@@ -1451,7 +1639,7 @@
-        }
- 
- #ifdef CONFIG_PM
--       // TODO
-+       /* TODO */
- #endif
- 
- #ifdef CONFIG_CPU_FREQ
-@@ -1464,7 +1652,12 @@
-        /*
-         * Ok, now enable the LCD controller
-         */
--       set_ctrlr_state(fbi, C_ENABLE);
-+       pxafb_set_ctrlr_state(fbi, C_ENABLE);
-+//#ifdef CONFIG_PXA27x
-+//     LCCR4 |= (1 << 31); /* Disabel the PCD Divisor, PCDDIV */
-+//     LCCR4 |= (5 << 17); /* Undocumented feature */
-+//#endif
-+       init_waitqueue_head(&fcs_wait_eof);
- 
-        return 0;
- 
---- linux-2.6.24-rc1.orig/drivers/video/pxafb.h
-+++ linux-2.6.24-rc1/drivers/video/pxafb.h
-@@ -29,6 +29,60 @@
-        unsigned int lccr3;
- };
- 
-+struct pxafb_rgb {
-+       struct fb_bitfield      red;
-+       struct fb_bitfield      green;
-+       struct fb_bitfield      blue;
-+       struct fb_bitfield      transp;
-+};
-+
-+#ifdef CONFIG_PXA27x
-+/* PXA Overlay Framebuffer Support */
-+struct overlayfb_info
-+{
-+       struct fb_info  fb;
-+
-+       struct fb_var_screeninfo old_var;
-+
-+       struct semaphore mutex;
-+       unsigned long    refcount;
-+
-+       struct pxafb_info *basefb;
-+
-+       unsigned long   map_cpu;
-+       unsigned long   screen_cpu;
-+       unsigned long   palette_cpu;
-+       unsigned long   map_size;
-+       unsigned long   palette_size;
-+
-+       dma_addr_t      screen_dma;
-+       dma_addr_t      map_dma;
-+       dma_addr_t      palette_dma;
-+
-+       volatile u_char state;
-+
-+       /* overlay specific info */
-+       unsigned long   xpos;           /* screen position (x, y)*/
-+       unsigned long   ypos;
-+       unsigned long   format;
-+
-+       /* additional */
-+       union {
-+               struct pxafb_dma_descriptor *dma0;
-+               struct pxafb_dma_descriptor *dma1;
-+               struct {
-+                       struct pxafb_dma_descriptor *dma2;
-+                       struct pxafb_dma_descriptor *dma3;
-+                       struct pxafb_dma_descriptor *dma4;
-+               };
-+               struct {
-+                       struct pxafb_dma_descriptor *dma5_pal;
-+                       struct pxafb_dma_descriptor *dma5_frame;
-+               };
-+       };
-+};
-+#endif
-+
- /* PXA LCD DMA descriptor */
- struct pxafb_dma_descriptor {
-        unsigned int fdadr;
-@@ -90,6 +144,14 @@
-        wait_queue_head_t       ctrlr_wait;
-        struct work_struct      task;
- 
-+#ifdef CONFIG_PXA27x
-+       /* PXA Overlay Framebuffer Support */
-+       struct overlayfb_info  *overlay1fb;
-+       struct overlayfb_info  *overlay2fb;
-+       struct overlayfb_info  *cursorfb;
-+#endif
-+       void (*set_overlay_ctrlr_state)(struct pxafb_info *, u_int);
-+
- #ifdef CONFIG_CPU_FREQ
-        struct notifier_block   freq_transition;
-        struct notifier_block   freq_policy;
-@@ -109,6 +171,9 @@
- #define C_DISABLE_PM           (5)
- #define C_ENABLE_PM            (6)
- #define C_STARTUP              (7)
-+#define C_BLANK                (8)
-+#define C_UNBLANK              (9)
-+
- 
- #define PXA_NAME       "PXA"
- 
---- /dev/null
-+++ linux-2.6.24-rc1/drivers/video/pxafb_overlay.c
-@@ -0,0 +1,1525 @@
-+/*
-+ *  linux/drivers/video/pxafb_overlay.c
-+ *
-+ *  Copyright (c) 2004, Intel Corporation
-+ *
-+ *     Code Status:
-+ *     2004/10/28: <yan.yin@intel.com>
-+ *      - Ported to 2.6 kernel
-+ *      - Made overlay driver a loadable module
-+ *      - Merged overlay optimized patch
-+ *     2004/03/10: <stanley.cai@intel.com>
-+ *      - Fixed Bugs
-+ *      - Added workaround for overlay1&2
-+ *     2003/08/27: <yu.tang@intel.com>
-+ *      - Added Overlay 1 & Overlay2 & Hardware Cursor support
-+ *
-+ *
-+ *     This software program is licensed subject to the GNU Lesser General
-+ *     Public License (LGPL). Version 2.1, February 1999, available at
-+ *     http://www.gnu.org/copyleft/lesser.html
-+ *
-+ *     Intel PXA27x LCD Controller Frame Buffer Overlay Driver
-+ *
-+ *
-+ */
-+
-+#include <linux/module.h>
-+#include <linux/moduleparam.h>
-+#include <linux/kernel.h>
-+#include <linux/sched.h>
-+#include <linux/errno.h>
-+#include <linux/string.h>
-+#include <linux/interrupt.h>
-+#include <linux/slab.h>
-+#include <linux/fb.h>
-+#include <linux/delay.h>
-+#include <linux/init.h>
-+#include <linux/ioport.h>
-+#include <linux/cpufreq.h>
-+#include <linux/device.h>
-+#include <linux/platform_device.h>
-+#include <linux/dma-mapping.h>
-+
-+#include <asm/hardware.h>
-+#include <asm/io.h>
-+#include <asm/irq.h>
-+#include <asm/uaccess.h>
-+#include <asm/arch/bitfield.h>
-+#include <asm/arch/pxafb.h>
-+#include <asm/arch/pxa-regs.h>
-+
-+#include "pxafb.h"
-+
-+/* LCD enhancement : Overlay 1 & 2 & Hardware Cursor */
-+
-+/*
-+ * LCD enhancement : Overlay 1
-+ *
-+ * Features:
-+ * - support 16bpp (No palette)
-+ */
-+/*
-+ * debugging?
-+ */
-+#define DEBUG 0
-+
-+#ifdef  DEBUG
-+#define dbg(fmt,arg...) printk(KERN_ALERT "%s(): " fmt "\n", __FUNCTION__, ##arg)
-+#else
-+#define dbg(fmt,arg...)
-+#endif
-+
-+static int overlay1fb_enable(struct fb_info *info);
-+static int overlay2fb_enable(struct fb_info *info);
-+static int cursorfb_enable(struct fb_info *info);
-+
-+static int overlay1fb_disable(struct fb_info *info);
-+static int overlay2fb_disable(struct fb_info *info);
-+static int cursorfb_disable(struct fb_info *info);
-+
-+static int overlay1fb_blank(int blank, struct fb_info *info);
-+static int overlay2fb_blank(int blank, struct fb_info *info);
-+static int cursorfb_blank(int blank, struct fb_info *info);
-+
-+extern void pxafb_set_ctrlr_state(struct pxafb_info *fbi, u_int state);
-+extern int pxafb_blank(int blank, struct fb_info *info);
-+
-+static struct pxafb_rgb def_rgb_18 = {
-+       red:    { offset: 12, length: 6, },
-+       green:  { offset: 6,  length: 6, },
-+       blue:   { offset: 0,  length: 6, },
-+       transp: { offset: 0,  length: 0, },
-+};
-+
-+static struct pxafb_rgb def_rgbt_16 = {
-+       red:    { offset: 10, length: 5, },
-+       green:  { offset: 5,  length: 5, },
-+       blue:   { offset: 0,  length: 5, },
-+       transp: { offset: 15,  length: 1, },
-+};
-+
-+static struct pxafb_rgb  def_rgbt_19 = {
-+       red:    { offset: 12, length: 6, },
-+       green:  { offset: 6,  length: 6, },
-+       blue:   { offset: 0,  length: 6, },
-+       transp: { offset: 18, length: 1, },
-+};
-+
-+static struct pxafb_rgb def_rgbt_24 = {
-+       red:    { offset: 16, length: 7, },
-+       green:  { offset: 8,  length: 8, },
-+       blue:   { offset: 0,  length: 8, },
-+       transp: { offset: 0,  length: 0, },
-+};
-+
-+static struct pxafb_rgb def_rgbt_25 = {
-+       red:    { offset: 16, length: 8, },
-+       green:  { offset: 8,  length: 8, },
-+       blue:   { offset: 0,  length: 8, },
-+       transp: { offset: 24, length: 1, },
-+};
-+
-+#define CLEAR_LCD_INTR(reg, intr) do {  \
-+       reg = (intr);                   \
-+}while(0)
-+
-+#define WAIT_FOR_LCD_INTR(reg,intr,timeout) ({ \
-+       int __done =0;                          \
-+       int __t = timeout;                      \
-+       while (__t) {                           \
-+               __done = (reg) & (intr);        \
-+               if (__done) break;              \
-+               mdelay(10);                     \
-+               __t--;                          \
-+       }                                       \
-+       if (!__t) dbg("wait " #intr " timeount");\
-+       __done;                                 \
-+})
-+
-+#define DISABLE_OVERLAYS(fbi) do {                                     \
-+       if (fbi->overlay1fb && (fbi->overlay1fb->state == C_ENABLE)) {  \
-+               overlay1fb_disable((struct fb_info*)fbi->overlay1fb);   \
-+       }                                                               \
-+       if (fbi->overlay2fb && (fbi->overlay2fb->state == C_ENABLE)) {  \
-+               overlay2fb_disable((struct fb_info*)fbi->overlay2fb);   \
-+       }                                                               \
-+       if (fbi->cursorfb && (fbi->cursorfb->state == C_ENABLE)) {      \
-+               cursorfb_disable((struct fb_info*)fbi->cursorfb);       \
-+       }                                                               \
-+}while(0)
-+
-+#define ENABLE_OVERLAYS(fbi) do {                                      \
-+       if (fbi->overlay1fb && (fbi->overlay1fb->state == C_DISABLE)) { \
-+               overlay1fb_enable((struct fb_info*)fbi->overlay1fb);    \
-+       }                                                               \
-+       if (fbi->overlay2fb && (fbi->overlay2fb->state == C_DISABLE)) { \
-+               overlay2fb_enable((struct fb_info*)fbi->overlay2fb);    \
-+       }                                                               \
-+       if (fbi->cursorfb && (fbi->cursorfb->state == C_DISABLE)) {     \
-+               cursorfb_enable((struct fb_info*)fbi->cursorfb);        \
-+       }                                                               \
-+}while(0)
-+
-+#define BLANK_OVERLAYS(fbi) do {                                       \
-+       if (fbi->overlay1fb && (fbi->overlay1fb->state == C_ENABLE)) {  \
-+               overlay1fb_disable((struct fb_info*)fbi->overlay1fb);   \
-+               fbi->overlay1fb->state = C_BLANK;                       \
-+       }                                                               \
-+       if (fbi->overlay2fb && (fbi->overlay2fb->state == C_ENABLE)) {  \
-+               overlay2fb_disable((struct fb_info*)fbi->overlay2fb);   \
-+               fbi->overlay2fb->state = C_BLANK;                       \
-+       }                                                               \
-+       if (fbi->cursorfb && (fbi->cursorfb->state == C_ENABLE)) {      \
-+               cursorfb_disable((struct fb_info*)fbi->cursorfb);       \
-+               fbi->cursorfb->state = C_BLANK;                 \
-+       }                                                               \
-+}while(0)
-+
-+#define UNBLANK_OVERLAYS(fbi) do {                                     \
-+       if (fbi->overlay1fb && (fbi->overlay1fb->state == C_BLANK)) {   \
-+               overlay1fb_enable((struct fb_info*)fbi->overlay1fb);    \
-+               fbi->overlay1fb->state = C_ENABLE;                      \
-+       }                                                               \
-+       if (fbi->overlay2fb && (fbi->overlay2fb->state == C_BLANK)) {   \
-+               overlay2fb_enable((struct fb_info*)fbi->overlay2fb);    \
-+               fbi->overlay2fb->state = C_ENABLE;                      \
-+       }                                                               \
-+       if (fbi->cursorfb && (fbi->cursorfb->state == C_BLANK)) {       \
-+               cursorfb_enable((struct fb_info*)fbi->cursorfb);        \
-+               fbi->cursorfb->state = C_ENABLE;                        \
-+       }                                                               \
-+}while(0)
-+
-+static int overlay1fb_open(struct fb_info *info, int user)
-+{
-+       struct overlayfb_info *fbi = (struct overlayfb_info*) info;
-+       int ret = 0;
-+
-+/* If basefb is disable, enable fb. */
-+       if (fbi->basefb && fbi->basefb->state != C_ENABLE)
-+               pxafb_blank(VESA_NO_BLANKING, (struct fb_info *)(fbi->basefb));
-+
-+       down(&fbi->mutex);
-+
-+       if (fbi->refcount)
-+               ret = -EACCES;
-+       else
-+               fbi->refcount ++;
-+
-+       up(&fbi->mutex);
-+
-+       /* Initialize the variables in overlay1 framebuffer. */
-+       fbi->fb.var.xres = fbi->fb.var.yres = 0;
-+       fbi->fb.var.bits_per_pixel = 0;
-+
-+       return ret;
-+}
-+
-+static int overlay1fb_release(struct fb_info *info, int user)
-+{
-+       struct overlayfb_info *fbi = (struct overlayfb_info*) info;
-+       down(&fbi->mutex);
-+
-+       if (fbi->refcount)
-+               fbi->refcount --;
-+
-+       up(&fbi->mutex);
-+       /* disable overlay when released */
-+       overlay1fb_blank(1, info);
-+
-+       return 0;
-+}
-+
-+static int overlay1fb_map_video_memory(struct fb_info *info)
-+{
-+       struct overlayfb_info *fbi = (struct overlayfb_info*) info;
-+
-+       if (fbi->map_cpu)
-+               dma_free_writecombine(NULL, fbi->map_size, (void*)fbi->map_cpu,  fbi->map_dma);
-+       fbi->map_size = PAGE_ALIGN(fbi->fb.fix.smem_len + PAGE_SIZE);
-+
-+       fbi->map_cpu = (unsigned long)dma_alloc_writecombine(NULL, fbi->map_size,
-+                                              &fbi->map_dma, GFP_KERNEL );
-+
-+       if (!fbi->map_cpu) return -ENOMEM;
-+
-+       fbi->screen_cpu = fbi->map_cpu + PAGE_SIZE;
-+       fbi->screen_dma = fbi->map_dma + PAGE_SIZE;
-+
-+       fbi->fb.fix.smem_start = fbi->screen_dma;
-+
-+       /* setup dma descriptor */
-+       fbi->dma1 = (struct pxafb_dma_descriptor*)
-+               (fbi->screen_cpu - sizeof(struct pxafb_dma_descriptor));
-+
-+       fbi->dma1->fdadr = (fbi->screen_dma - sizeof(struct pxafb_dma_descriptor));
-+       fbi->dma1->fsadr = fbi->screen_dma;
-+       fbi->dma1->fidr  = 0;
-+       fbi->dma1->ldcmd = fbi->fb.fix.smem_len;
-+
-+       return 0;
-+}
-+
-+static int overlay1fb_enable(struct fb_info *info)
-+{
-+       struct overlayfb_info *fbi = (struct overlayfb_info*) info;
-+       unsigned long bpp1;
-+
-+       if (!fbi->map_cpu) return -EINVAL;
-+
-+       switch (fbi->fb.var.bits_per_pixel) {
-+       case 16:
-+               bpp1 = 0x4;
-+               break;
-+       case 18:
-+               bpp1 = 0x6;
-+               break;
-+       case 19:
-+               bpp1 = 0x8;
-+               break;
-+       case 24:
-+               bpp1 = 0x9;
-+               break;
-+       case 25:
-+               bpp1 = 0xa;
-+               break;
-+       default:
-+               return -EINVAL;
-+       }
-+
-+       /* disable branch/start/end of frame interrupt */
-+       LCCR5 |= (LCCR5_IUM1 | LCCR5_BSM1 | LCCR5_EOFM1 | LCCR5_SOFM1);
-+
-+       if (fbi->state == C_DISABLE || fbi->state == C_BLANK)
-+               FDADR1 = (fbi->dma1->fdadr);
-+       else
-+               FBR1 = fbi->dma1->fdadr | 0x1;
-+
-+       /* enable overlay 1 window */
-+       OVL1C2 = (fbi->ypos << 10) | fbi->xpos;
-+       OVL1C1 = OVL1C1_O1EN | (bpp1 << 20) | ((fbi->fb.var.yres-1)<<10) | (fbi->fb.var.xres-1);
-+
-+       fbi->state = C_ENABLE;
-+
-+       return 0;
-+}
-+
-+static int overlay1fb_disable(struct fb_info *info)
-+{
-+       struct overlayfb_info *fbi = (struct overlayfb_info*)info;
-+       int done;
-+
-+       if ((fbi->state == C_DISABLE) || (fbi->state == C_BLANK))
-+               return 0;
-+
-+       fbi->state = C_DISABLE;
-+
-+       /* clear O1EN */
-+       OVL1C1 &= ~OVL1C1_O1EN;
-+
-+       CLEAR_LCD_INTR(LCSR1, LCSR1_BS1);
-+       FBR1 = 0x3;
-+       done = WAIT_FOR_LCD_INTR(LCSR1, LCSR1_BS1, 100);
-+
-+       if (!done) {
-+               pr_debug(KERN_INFO "%s: timeout\n", __FUNCTION__);
-+               return -1;
-+       }
-+       return 0;
-+}
-+
-+static int overlay1fb_blank(int blank, struct fb_info *info)
-+{
-+       struct overlayfb_info *fbi = (struct overlayfb_info*) info;
-+       int err=0;
-+
-+       switch (blank) {
-+       case 0:
-+               err = overlay1fb_enable(info);
-+               if (err) {
-+                       fbi->state = C_DISABLE;
-+                       pxafb_set_ctrlr_state(fbi->basefb, C_REENABLE);
-+               }
-+               break;
-+       case 1:
-+               err = overlay1fb_disable(info);
-+               if (err) {
-+                       fbi->state = C_DISABLE;
-+                       pxafb_set_ctrlr_state(fbi->basefb, C_REENABLE);
-+               }
-+               break;
-+       default:
-+               break;
-+       }
-+
-+       return err;
-+}
-+
-+static int overlay1fb_check_var( struct fb_var_screeninfo *var, struct fb_info *info)
-+{
-+       int xpos, ypos;
-+       struct overlayfb_info *fbi=(struct overlayfb_info*)info;
-+
-+       /* must in base frame */
-+       xpos = (var->nonstd & 0x3ff);
-+       ypos = ((var->nonstd>>10) & 0x3ff);
-+
-+       if ( (xpos + var->xres) > fbi->basefb->fb.var.xres )
-+               return -EINVAL;
-+
-+       if ( (ypos + var->yres) > fbi->basefb->fb.var.yres )
-+               return -EINVAL;
-+
-+       switch (var->bits_per_pixel) {
-+       case 16:
-+               if ( var->xres & 0x1 ) {
-+                       printk("xres should be a multiple of 2 pixels!\n");
-+                       return -EINVAL;
-+               }
-+               break;
-+       case 18:
-+       case 19:
-+               if ( var->xres & 0x7 ) {
-+                       printk("xres should be a multiple of 8 pixels!\n");
-+                       return -EINVAL;
-+               }
-+               break;
-+       default:
-+               break;
-+       }
-+
-+       fbi->old_var=*var;
-+
-+       var->activate=FB_ACTIVATE_NOW;
-+
-+       return 0;
-+}
-+
-+
-+static int overlay1fb_set_par(struct fb_info *info)
-+{
-+       int nbytes=0, err=0, pixels_per_line=0;
-+
-+       struct overlayfb_info *fbi=(struct overlayfb_info*)info;
-+       struct fb_var_screeninfo *var = &fbi->fb.var;
-+
-+       info->flags &= ~FBINFO_MISC_USEREVENT;
-+
-+       if (fbi->state == C_BLANK)
-+               return 0;
-+
-+       if (fbi->state == C_DISABLE)
-+               goto out1;
-+
-+       /* only xpos & ypos change */
-+       if ( (var->xres == fbi->old_var.xres) &&
-+               (var->yres == fbi->old_var.yres) &&
-+               (var->bits_per_pixel == fbi->old_var.bits_per_pixel) )
-+               goto out2;
-+
-+out1:
-+       switch(var->bits_per_pixel) {
-+               case 16:
-+                       /* 2 pixels per line */
-+                       pixels_per_line = (fbi->fb.var.xres + 0x1) & (~0x1);
-+                       nbytes = 2;
-+
-+                       var->red    = def_rgbt_16.red;
-+                       var->green  = def_rgbt_16.green;
-+                       var->blue   = def_rgbt_16.blue;
-+                       var->transp = def_rgbt_16.transp;
-+
-+                       break;
-+               case 18:
-+                       /* 8 pixels per line */
-+                       pixels_per_line = (fbi->fb.var.xres + 0x7 ) & (~0x7);
-+                       nbytes = 3;
-+
-+                       var->red    = def_rgb_18.red;
-+                       var->green  = def_rgb_18.green;
-+                       var->blue   = def_rgb_18.blue;
-+                       var->transp = def_rgb_18.transp;
-+
-+                       break;
-+               case 19:
-+                       /* 8 pixels per line */
-+                       pixels_per_line = (fbi->fb.var.xres + 0x7 ) & (~0x7);
-+                       nbytes = 3;
-+
-+                       var->red    = def_rgbt_19.red;
-+                       var->green  = def_rgbt_19.green;
-+                       var->blue   = def_rgbt_19.blue;
-+                       var->transp = def_rgbt_19.transp;
-+
-+                       break;
-+               case 24:
-+                       pixels_per_line = fbi->fb.var.xres;
-+                       nbytes = 4;
-+
-+                       var->red    = def_rgbt_24.red;
-+                       var->green  = def_rgbt_24.green;
-+                       var->blue   = def_rgbt_24.blue;
-+                       var->transp = def_rgbt_24.transp;
-+
-+                       break;
-+               case 25:
-+                       pixels_per_line = fbi->fb.var.xres;
-+                       nbytes = 4;
-+
-+                       var->red    = def_rgbt_25.red;
-+                       var->green  = def_rgbt_25.green;
-+                       var->blue   = def_rgbt_25.blue;
-+                       var->transp = def_rgbt_25.transp;
-+
-+                       break;
-+               }
-+
-+               fbi->fb.fix.line_length = nbytes * pixels_per_line;
-+               fbi->fb.fix.smem_len = fbi->fb.fix.line_length * fbi->fb.var.yres;
-+
-+               err= overlay1fb_map_video_memory((struct fb_info*)fbi);
-+
-+               if (err)
-+                       return err;
-+
-+out2:
-+               fbi->xpos = var->nonstd & 0x3ff;
-+               fbi->ypos = (var->nonstd>>10) & 0x3ff;
-+
-+               overlay1fb_enable(info);
-+
-+               return 0;
-+
-+}
-+
-+static struct fb_ops overlay1fb_ops = {
-+       .owner                  = THIS_MODULE,
-+       .fb_open                = overlay1fb_open,
-+       .fb_release             = overlay1fb_release,
-+       .fb_check_var           = overlay1fb_check_var,
-+       .fb_set_par             = overlay1fb_set_par,
-+       .fb_blank               = overlay1fb_blank,
-+       .fb_fillrect            = cfb_fillrect,
-+       .fb_copyarea            = cfb_copyarea,
-+       .fb_imageblit           = cfb_imageblit,
-+};
-+
-+ /*
-+ * LCD enhancement : Overlay 2
-+ *
-+ * Features:
-+ * - support planar YCbCr420/YCbCr422/YCbCr444;
-+ */
-+static int overlay2fb_open(struct fb_info *info, int user)
-+{
-+       struct overlayfb_info *fbi = (struct overlayfb_info*) info;
-+       int ret = 0;
-+
-+       /* if basefb is disable, enable fb. */
-+       if (fbi->basefb && fbi->basefb->state != C_ENABLE)
-+               pxafb_blank(VESA_NO_BLANKING, (struct fb_info *)(fbi->basefb));
-+
-+       down(&fbi->mutex);
-+
-+       if (fbi->refcount)
-+               ret = -EACCES;
-+       else
-+               fbi->refcount ++;
-+
-+       up(&fbi->mutex);
-+       fbi->fb.var.xres = fbi->fb.var.yres = 0;
-+
-+       return ret;
-+}
-+
-+static int overlay2fb_release(struct fb_info *info, int user)
-+{
-+       struct overlayfb_info *fbi = (struct overlayfb_info*) info;
-+
-+       down(&fbi->mutex);
-+
-+       if (fbi->refcount)
-+               fbi->refcount --;
-+
-+       up(&fbi->mutex);
-+
-+       /* disable overlay when released */
-+       overlay2fb_blank(1, info);
-+
-+       return 0;
-+}
-+
-+static int overlay2fb_map_YUV_memory( struct fb_info *info)
-+{
-+       struct overlayfb_info *fbi = (struct overlayfb_info*) info;
-+       unsigned int ylen, cblen, crlen, aylen, acblen, acrlen;
-+       unsigned int yoff, cboff, croff;
-+       unsigned int xres,yres;
-+       unsigned int nbytes;
-+
-+       ylen = cblen = crlen = aylen = acblen = acrlen = 0;
-+       yoff = cboff = croff = 0;
-+
-+       if (fbi->map_cpu)
-+               dma_free_writecombine(NULL, fbi->map_size, (void*)fbi->map_cpu,  fbi->map_dma);
-+
-+       yres = fbi->fb.var.yres;
-+
-+       switch(fbi->format) {
-+       case 0x4: /* YCbCr 4:2:0 planar */
-+               pr_debug("420 planar\n");
-+               /* 16 pixels per line */
-+               xres = (fbi->fb.var.xres + 0xf) & (~0xf);
-+               fbi->fb.fix.line_length = xres;
-+
-+               nbytes = xres * yres;
-+               ylen = nbytes;
-+               cblen = crlen = (nbytes/4);
-+
-+               break;
-+       case 0x3: /* YCbCr 4:2:2 planar */
-+               /* 8 pixles per line */
-+               pr_debug("422 planar\n");
-+               xres = (fbi->fb.var.xres + 0x7) & (~0x7);
-+               fbi->fb.fix.line_length = xres;
-+
-+               nbytes = xres * yres;
-+               ylen  = nbytes;
-+               cblen = crlen = (nbytes/2);
-+
-+               break;
-+       case 0x2: /* YCbCr 4:4:4 planar */
-+               /* 4 pixels per line */
-+               pr_debug("444 planar\n");
-+               xres = (fbi->fb.var.xres + 0x3) & (~0x3);
-+               fbi->fb.fix.line_length = xres;
-+
-+               nbytes = xres * yres;
-+               ylen  = cblen = crlen = nbytes;
-+               break;
-+       }
-+
-+       /* 16-bytes alignment for DMA */
-+       aylen  = (ylen + 0xf) & (~0xf);
-+       acblen = (cblen + 0xf) & (~0xf);
-+       acrlen = (crlen + 0xf) & (~0xf);
-+
-+       fbi->fb.fix.smem_len = aylen + acblen + acrlen;
-+
-+       /* alloc memory */
-+
-+       fbi->map_size = PAGE_ALIGN(fbi->fb.fix.smem_len + PAGE_SIZE);
-+       fbi->map_cpu = (unsigned long)dma_alloc_writecombine(NULL, fbi->map_size,
-+                                              &fbi->map_dma, GFP_KERNEL );
-+
-+       if (!fbi->map_cpu) return -ENOMEM;
-+
-+       fbi->screen_cpu = fbi->map_cpu + PAGE_SIZE;
-+       fbi->screen_dma = fbi->map_dma + PAGE_SIZE;
-+
-+       fbi->fb.fix.smem_start = fbi->screen_dma;
-+
-+       /* setup dma for Planar format */
-+       fbi->dma2 = (struct pxafb_dma_descriptor*)
-+               (fbi->screen_cpu - sizeof(struct pxafb_dma_descriptor));
-+       fbi->dma3 = fbi->dma2 - 1;
-+       fbi->dma4 = fbi->dma3 - 1;
-+
-+       /* offset */
-+       yoff = 0;
-+       cboff = aylen;
-+       croff = cboff + acblen;
-+
-+       /* Y vector */
-+       fbi->dma2->fdadr = (fbi->screen_dma - sizeof(struct pxafb_dma_descriptor));
-+       fbi->dma2->fsadr = fbi->screen_dma + yoff;
-+       fbi->dma2->fidr  = 0;
-+       fbi->dma2->ldcmd = ylen;
-+
-+       /* Cb vector */
-+       fbi->dma3->fdadr = (fbi->dma2->fdadr - sizeof(struct pxafb_dma_descriptor));
-+       fbi->dma3->fsadr = (fbi->screen_dma + cboff);
-+       fbi->dma3->fidr  = 0;
-+       fbi->dma3->ldcmd = cblen;
-+
-+       /* Cr vector */
-+
-+       fbi->dma4->fdadr = (fbi->dma3->fdadr - sizeof(struct pxafb_dma_descriptor));
-+       fbi->dma4->fsadr = (fbi->screen_dma + croff);
-+       fbi->dma4->fidr  = 0;
-+       fbi->dma4->ldcmd = crlen;
-+
-+       /* adjust for user */
-+       fbi->fb.var.red.length   = ylen;
-+       fbi->fb.var.red.offset   = yoff;
-+       fbi->fb.var.green.length = cblen;
-+       fbi->fb.var.green.offset = cboff;
-+       fbi->fb.var.blue.length  = crlen;
-+       fbi->fb.var.blue.offset  = croff;
-+
-+       return 0;
-+};
-+
-+static int overlay2fb_map_RGB_memory( struct fb_info *info)
-+{
-+       struct overlayfb_info *fbi = (struct overlayfb_info*) info;
-+       struct fb_var_screeninfo *var = &fbi->fb.var;
-+       int pixels_per_line=0 , nbytes=0;
-+
-+       if (fbi->map_cpu)
-+               dma_free_writecombine(NULL,  fbi->map_size, (void*)fbi->map_cpu, fbi->map_dma);
-+
-+       switch(var->bits_per_pixel) {
-+       case 16:
-+               /* 2 pixels per line */
-+               pixels_per_line = (fbi->fb.var.xres + 0x1) & (~0x1);
-+               nbytes = 2;
-+
-+               var->red    = def_rgbt_16.red;
-+               var->green  = def_rgbt_16.green;
-+               var->blue   = def_rgbt_16.blue;
-+               var->transp = def_rgbt_16.transp;
-+               break;
-+
-+       case 18:
-+               /* 8 pixels per line */
-+               pixels_per_line = (fbi->fb.var.xres + 0x7 ) & (~0x7);
-+               nbytes = 3;
-+
-+               var->red    = def_rgb_18.red;
-+               var->green  = def_rgb_18.green;
-+               var->blue   = def_rgb_18.blue;
-+               var->transp = def_rgb_18.transp;
-+
-+               break;
-+       case 19:
-+               /* 8 pixels per line */
-+               pixels_per_line = (fbi->fb.var.xres + 0x7 ) & (~0x7);
-+               nbytes = 3;
-+
-+               var->red    = def_rgbt_19.red;
-+               var->green  = def_rgbt_19.green;
-+               var->blue   = def_rgbt_19.blue;
-+               var->transp = def_rgbt_19.transp;
-+
-+               break;
-+       case 24:
-+               pixels_per_line = fbi->fb.var.xres;
-+               nbytes = 4;
-+
-+               var->red    = def_rgbt_24.red;
-+               var->green  = def_rgbt_24.green;
-+               var->blue   = def_rgbt_24.blue;
-+               var->transp = def_rgbt_24.transp;
-+
-+               break;
-+
-+       case 25:
-+               pixels_per_line = fbi->fb.var.xres;
-+               nbytes = 4;
-+
-+               var->red    = def_rgbt_25.red;
-+               var->green  = def_rgbt_25.green;
-+               var->blue   = def_rgbt_25.blue;
-+               var->transp = def_rgbt_25.transp;
-+
-+               break;
-+       }
-+
-+       fbi->fb.fix.line_length = nbytes * pixels_per_line;
-+       fbi->fb.fix.smem_len = fbi->fb.fix.line_length * fbi->fb.var.yres;
-+
-+       fbi->map_size = PAGE_ALIGN(fbi->fb.fix.smem_len + PAGE_SIZE);
-+       fbi->map_cpu = (unsigned long)dma_alloc_writecombine(NULL, fbi->map_size,
-+                                              &fbi->map_dma, GFP_KERNEL );
-+
-+       if (!fbi->map_cpu) return -ENOMEM;
-+
-+       fbi->screen_cpu = fbi->map_cpu + PAGE_SIZE;
-+       fbi->screen_dma = fbi->map_dma + PAGE_SIZE;
-+
-+       fbi->fb.fix.smem_start = fbi->screen_dma;
-+
-+       /* setup dma descriptor */
-+       fbi->dma2 = (struct pxafb_dma_descriptor*)
-+               (fbi->screen_cpu - sizeof(struct pxafb_dma_descriptor));
-+
-+       fbi->dma2->fdadr = (fbi->screen_dma - sizeof(struct pxafb_dma_descriptor));
-+       fbi->dma2->fsadr = fbi->screen_dma;
-+       fbi->dma2->fidr  = 0;
-+       fbi->dma2->ldcmd = fbi->fb.fix.smem_len;
-+
-+       return 0;
-+}
-+
-+static int overlay2fb_enable(struct fb_info *info)
-+{
-+       struct overlayfb_info *fbi = (struct overlayfb_info*) info;
-+       unsigned long bpp2;
-+       unsigned int xres, yres;
-+
-+       if (!fbi->map_cpu) return -EINVAL;
-+
-+       switch(fbi->fb.var.bits_per_pixel) {
-+       case 16:
-+               bpp2 = 0x4;
-+               break;
-+       case 18:
-+               bpp2 = 0x6;
-+               break;
-+       case 19:
-+               bpp2 = 0x8;
-+               break;
-+       case 24:
-+               bpp2 = 0x9;
-+               break;
-+       case 25:
-+               bpp2 = 0xa;
-+               break;
-+       default:
-+               return -EINVAL;
-+       }
-+
-+        /* disable branch/start/end of frame interrupt */
-+       LCCR5 |= (LCCR5_IUM4 | LCCR5_IUM3 | LCCR5_IUM2 |
-+                 LCCR5_BSM4 | LCCR5_BSM3 | LCCR5_BSM2 |
-+                 LCCR5_EOFM4 | LCCR5_EOFM3 | LCCR5_EOFM2 |
-+                 LCCR5_SOFM4 | LCCR5_SOFM3 | LCCR5_SOFM2);
-+
-+       if (fbi->format == 0) {
-+               /* overlay2 RGB resolution, RGB and YUV have different xres value*/
-+               xres = fbi->fb.var.xres;
-+               yres = fbi->fb.var.yres;
-+
-+               OVL2C2 = (fbi->format << 20) | (fbi->ypos << 10) | fbi->xpos;
-+               OVL2C1 = OVL2C1_O2EN | (bpp2 << 20) | ((yres-1)<<10) | (xres-1);
-+               /* setup RGB DMA */
-+               if (fbi->state == C_DISABLE || fbi->state == C_BLANK)
-+                       FDADR2 = fbi->dma2->fdadr;
-+               else
-+                       FBR2 = fbi->dma2->fdadr | 0x1;
-+       } else {
-+               /* overlay2 YUV resolution */
-+               xres = fbi->fb.fix.line_length;
-+               yres = fbi->fb.var.yres;
-+
-+               OVL2C2 = (fbi->format << 20) | (fbi->ypos << 10) | fbi->xpos;
-+               OVL2C1 = OVL2C1_O2EN | (bpp2 << 20) | ((yres-1)<<10) | (xres-1);
-+
-+               if (fbi->state == C_DISABLE || fbi->state == C_BLANK) {
-+                       FDADR2 = fbi->dma2->fdadr;
-+                       FDADR3 = fbi->dma3->fdadr;
-+                       FDADR4 = fbi->dma4->fdadr;
-+               } else {
-+                       FBR2 = fbi->dma2->fdadr | 0x01;
-+                       FBR3 = fbi->dma3->fdadr | 0x01;
-+                       FBR4 = fbi->dma4->fdadr | 0x01;
-+               }
-+       }
-+
-+       fbi->state = C_ENABLE;
-+       return 0;
-+}
-+
-+static int overlay2fb_disable(struct fb_info *info)
-+{
-+       struct overlayfb_info *fbi = (struct overlayfb_info*)info;
-+       int done;
-+
-+       if (fbi->state == C_DISABLE)
-+               return 0;
-+       if (fbi->state == C_BLANK) {
-+               fbi->state = C_DISABLE;
-+               return 0;
-+       }
-+
-+       fbi->state = C_DISABLE;
-+
-+       /* clear O2EN */
-+       OVL2C1 &= ~OVL2C1_O2EN;
-+
-+       /* Make overlay2 can't disable/enable
-+        * correctly sometimes.
-+        */
-+       CLEAR_LCD_INTR(LCSR1, LCSR1_BS2);
-+
-+       if (fbi->format == 0)
-+               FBR2 = 0x3;
-+       else {
-+               FBR2 = 0x3;
-+               FBR3 = 0x3;
-+               FBR4 = 0x3;
-+       }
-+
-+       done = WAIT_FOR_LCD_INTR(LCSR1, LCSR1_BS2, 100);
-+
-+       if (!done) {
-+               pr_debug(KERN_INFO "%s: timeout\n", __FUNCTION__);
-+               return -1;
-+       }
-+       return 0;
-+}
-+
-+static int overlay2fb_blank(int blank, struct fb_info *info)
-+{
-+       struct overlayfb_info *fbi = (struct overlayfb_info*) info;
-+       int err=0;
-+
-+       switch(blank)
-+       {
-+       case 0:
-+               err = overlay2fb_enable(info);
-+               if (err) {
-+                       fbi->state = C_DISABLE;
-+                       pxafb_set_ctrlr_state(fbi->basefb, C_REENABLE);
-+               }
-+               break;
-+       case 1:
-+               err = overlay2fb_disable(info);
-+               if (err) {
-+                       fbi->state = C_DISABLE;
-+                       pxafb_set_ctrlr_state(fbi->basefb, C_REENABLE);
-+               }
-+               break;
-+       default:
-+               /* reserved */
-+               break;
-+       }
-+
-+       return err;
-+}
-+
-+
-+static int overlay2fb_check_var( struct fb_var_screeninfo *var, struct fb_info *info)
-+{
-+       int xpos, ypos, xres, yres;
-+       int format;
-+       struct overlayfb_info *fbi=(struct overlayfb_info*)info;
-+
-+       xres=yres=0;
-+
-+       xpos = (var->nonstd & 0x3ff);
-+       ypos = (var->nonstd >> 10) & 0x3ff;
-+       format = (var->nonstd >>20) & 0x7;
-+
-+
-+       /* Palnar YCbCr444, YCbCr422, YCbCr420 */
-+       if ( (format != 0x4) && (format != 0x3) && (format != 0x2) && (format !=0x0))
-+               return -EINVAL;
-+
-+       /* dummy pixels */
-+       switch(format) {
-+       case 0x0: /* RGB */
-+               xres = var->xres;
-+               break;
-+       case 0x2: /* 444 */
-+               xres = (var->xres + 0x3) & ~(0x3);
-+               break;
-+       case 0x3: /* 422 */
-+               xres = (var->xres + 0x7) & ~(0x7);
-+               break;
-+       case 0x4: /* 420 */
-+               xres = (var->xres + 0xf) & ~(0xf);
-+               break;
-+       }
-+       yres = var->yres;
-+
-+       if ( (xpos + xres) > fbi->basefb->fb.var.xres )
-+               return -EINVAL;
-+
-+       if ( (ypos + yres) > fbi->basefb->fb.var.yres )
-+               return -EINVAL;
-+
-+       fbi->old_var=*var;
-+
-+       var->activate=FB_ACTIVATE_NOW;
-+
-+       return 0;
-+
-+}
-+
-+
-+/*
-+ * overlay2fb_set_var()
-+ *
-+ * var.nonstd is used as YCbCr format.
-+ * var.red/green/blue is used as (Y/Cb/Cr) vector
-+ */
-+
-+static int overlay2fb_set_par(struct fb_info *info)
-+{
-+       unsigned int xpos, ypos;
-+       int format, err;
-+
-+       struct overlayfb_info *fbi=(struct overlayfb_info*)info;
-+       struct fb_var_screeninfo *var = &fbi->fb.var;
-+
-+       info->flags &= ~FBINFO_MISC_USEREVENT;
-+
-+       if (fbi->state == C_BLANK)
-+               return 0;
-+
-+       if (fbi->state == C_DISABLE)
-+               goto out1;
-+
-+       if ( (var->xres == fbi->old_var.xres) &&
-+               (var->yres == fbi->old_var.yres) &&
-+               (var->bits_per_pixel == fbi->old_var.bits_per_pixel) &&
-+               (((var->nonstd>>20) & 0x7) == fbi->format) )
-+               goto out2;
-+
-+out1:
-+       xpos = var->nonstd & 0x3ff;
-+       ypos = (var->nonstd>>10) & 0x3ff;
-+       format = (var->nonstd>>20) & 0x7;
-+
-+
-+       fbi->format = format;
-+       if ( fbi->format==0 )
-+               err = overlay2fb_map_RGB_memory(info);
-+       else
-+               err = overlay2fb_map_YUV_memory(info);
-+
-+       if (err) return err;
-+
-+out2:
-+       /* position */
-+       fbi->xpos = var->nonstd & 0x3ff;
-+       fbi->ypos = (var->nonstd>>10) & 0x3ff;
-+
-+       overlay2fb_enable(info);
-+
-+       return 0;
-+}
-+
-+static struct fb_ops overlay2fb_ops = {
-+       .owner                  = THIS_MODULE,
-+       .fb_open                = overlay2fb_open,
-+       .fb_release             = overlay2fb_release,
-+       .fb_check_var           = overlay2fb_check_var,
-+       .fb_set_par             = overlay2fb_set_par,
-+       .fb_blank               = overlay2fb_blank,
-+       .fb_fillrect            = cfb_fillrect,
-+       .fb_copyarea            = cfb_copyarea,
-+       .fb_imageblit           = cfb_imageblit,
-+};
-+
-+/* Hardware cursor */
-+
-+/* Bulverde Cursor Modes */
-+struct cursorfb_mode{
-+       int xres;
-+       int yres;
-+       int bpp;
-+};
-+
-+static struct cursorfb_mode cursorfb_modes[]={
-+       { 32,  32, 2},
-+       { 32,  32, 2},
-+       { 32,  32, 2},
-+       { 64,  64, 2},
-+       { 64,  64, 2},
-+       { 64,  64, 2},
-+       {128, 128, 1},
-+       {128, 128, 1}
-+};
-+
-+static int cursorfb_enable(struct fb_info *info)
-+{
-+       struct overlayfb_info *fbi = (struct overlayfb_info*) info;
-+
-+       if (!fbi->map_cpu) return -EINVAL;
-+
-+       CCR &= ~CCR_CEN;
-+
-+       /* set palette format
-+        *
-+        * FIXME: if only cursor uses palette
-+        */
-+       LCCR4 = (LCCR4 & (~(0x3<<15))) | (0x1<<15);
-+
-+       /* disable branch/start/end of frame interrupt */
-+       LCCR5 |= (LCCR5_IUM5 | LCCR5_BSM5 | LCCR5_EOFM5 | LCCR5_SOFM5);
-+
-+       /* load palette and frame data */
-+       if (fbi->state == C_DISABLE) {
-+               FDADR5 = fbi->dma5_pal->fdadr;
-+               udelay(1);
-+               FDADR5 = fbi->dma5_frame->fdadr;
-+               udelay(1);
-+
-+       }
-+       else {
-+               FBR5 = fbi->dma5_pal->fdadr | 0x1;
-+               udelay(1);
-+               FBR5 = fbi->dma5_frame->fdadr | 0x1;
-+               udelay(1);
-+       }
-+
-+       CCR = CCR_CEN | (fbi->ypos << 15) | (fbi->xpos << 5) | (fbi->format);
-+
-+       fbi->state = C_ENABLE;
-+
-+       return 0;
-+}
-+
-+static int cursorfb_disable(struct fb_info *info)
-+{
-+       struct overlayfb_info *fbi = (struct overlayfb_info*)info;
-+       int done, ret = 0;
-+
-+       fbi->state = C_DISABLE;
-+
-+       done = WAIT_FOR_LCD_INTR(LCSR1, LCSR1_BS5, 100);
-+       if (!done) ret = -1;
-+
-+       CCR &= ~CCR_CEN;
-+
-+       return ret;
-+}
-+
-+static int cursorfb_setcolreg(u_int regno, u_int red, u_int green, u_int blue,
-+                      u_int trans, struct fb_info *info)
-+{
-+       struct overlayfb_info *fbi = (struct overlayfb_info *)info;
-+       u_int val, ret = 1;
-+       u_int *pal=(u_int*) fbi->palette_cpu;
-+
-+       /* 25bit with Transparcy for 16bpp format */
-+       if (regno < fbi->palette_size) {
-+               val = ((trans << 24)  & 0x1000000);
-+               val |= ((red << 16)  & 0x0ff0000);
-+               val |= ((green << 8 ) & 0x000ff00);
-+               val |= ((blue << 0) & 0x00000ff);
-+
-+               pal[regno] = val;
-+               ret = 0;
-+       }
-+       return ret;
-+}
-+
-+int cursorfb_blank(int blank, struct fb_info *info)
-+{
-+       switch(blank)
-+       {
-+       case 0:
-+               cursorfb_enable(info);
-+               break;
-+       case 1:
-+               cursorfb_disable(info);
-+               break;
-+       default:
-+               /* reserved */
-+               break;
-+       }
-+       return 0;
-+}
-+
-+static int cursorfb_check_var( struct fb_var_screeninfo *var, struct fb_info *info)
-+{
-+       int xpos, ypos, xres, yres;
-+       int mode;
-+       struct cursorfb_mode *cursor;
-+       struct overlayfb_info *fbi=(struct overlayfb_info*)info;
-+
-+       mode = var->nonstd & 0x7;
-+       xpos = (var->nonstd>>5) & 0x3ff;
-+       ypos = (var->nonstd>>15) & 0x3ff;
-+
-+       if (mode>7 || mode <0 )
-+               return -EINVAL;
-+
-+       cursor = cursorfb_modes + mode;
-+
-+       xres = cursor->xres;
-+       yres = cursor->yres;
-+
-+       if ( (xpos + xres) > fbi->basefb->fb.var.xres )
-+               return -EINVAL;
-+
-+       if ( (ypos + yres) > fbi->basefb->fb.var.yres )
-+               return -EINVAL;
-+
-+       return 0;
-+
-+}
-+
-+static int cursorfb_set_par(struct fb_info *info)
-+{
-+       struct overlayfb_info *fbi = (struct overlayfb_info*) info;
-+       struct fb_var_screeninfo *var = &fbi->fb.var;
-+       struct cursorfb_mode *cursor;
-+       int mode, xpos, ypos;
-+       int err;
-+
-+       info->flags &= ~FBINFO_MISC_USEREVENT;
-+
-+       mode = var->nonstd & 0x7;
-+       xpos = (var->nonstd>>5) & 0x3ff;
-+       ypos = (var->nonstd>>15) & 0x3ff;
-+
-+       if (mode != fbi->format) {
-+               cursor = cursorfb_modes + mode;
-+
-+               /* update "var" info */
-+               fbi->fb.var.xres = cursor->xres;
-+               fbi->fb.var.yres = cursor->yres;
-+               fbi->fb.var.bits_per_pixel = cursor->bpp;
-+
-+               /* alloc video memory
-+                *
-+                * 4k is engouh for 128x128x1 cursor,
-+                * - 2k for cursor pixels,
-+                * - 2k for palette data, plus 2 dma descriptor
-+                */
-+               if (!fbi->map_cpu) {
-+                       fbi->map_size = PAGE_SIZE;
-+                       fbi->map_cpu = (unsigned long)dma_alloc_writecombine(NULL, fbi->map_size,
-+                                              &fbi->map_dma, GFP_KERNEL );
-+                       if (!fbi->map_cpu) return -ENOMEM;
-+               }
-+
-+               cursor = cursorfb_modes + mode;
-+
-+               /* update overlay & fix "info" */
-+               fbi->screen_cpu         = fbi->map_cpu;
-+               fbi->palette_cpu        = fbi->map_cpu + (PAGE_SIZE/2);
-+               fbi->screen_dma         = fbi->map_dma;
-+               fbi->palette_dma        = fbi->map_dma + (PAGE_SIZE/2);
-+
-+               fbi->format             = mode;
-+               fbi->palette_size       = (1<<cursor->bpp);
-+               fbi->fb.fix.smem_start  = fbi->screen_dma;
-+               fbi->fb.fix.smem_len    = cursor->xres * cursor->yres * cursor->bpp / 8;
-+               fbi->fb.fix.line_length = cursor->xres * cursor->bpp / 8;
-+
-+               fbi->dma5_pal           = (struct pxafb_dma_descriptor*)(fbi->map_cpu + PAGE_SIZE - 16 );
-+               fbi->dma5_pal->fdadr    = (fbi->map_dma + PAGE_SIZE - 16);
-+               fbi->dma5_pal->fsadr    = fbi->palette_dma;
-+               fbi->dma5_pal->fidr     = 0;
-+               fbi->dma5_pal->ldcmd    = (fbi->palette_size<<2) | LDCMD_PAL;
-+
-+               fbi->dma5_frame                 = (struct pxafb_dma_descriptor*)(fbi->map_cpu + PAGE_SIZE - 32 );
-+               fbi->dma5_frame->fdadr  = (fbi->map_dma + PAGE_SIZE - 32);
-+               fbi->dma5_frame->fsadr  = fbi->screen_dma;
-+               fbi->dma5_frame->fidr   = 0;
-+               fbi->dma5_frame->ldcmd  = fbi->fb.fix.smem_len;
-+
-+               /* alloc & set default cmap */
-+               err = fb_alloc_cmap(&fbi->fb.cmap, fbi->palette_size, 0);
-+               if (err) return err;
-+               err = fb_set_cmap(&fbi->fb.cmap, info);
-+               if (err) return err;
-+       }
-+
-+       /* update overlay info */
-+       if ( (xpos != fbi->xpos) || (ypos != fbi->ypos) ) {
-+               fbi->xpos = xpos;
-+               fbi->ypos = ypos;
-+       }
-+
-+       cursorfb_enable(info);
-+       pxafb_set_ctrlr_state(fbi->basefb, C_REENABLE);
-+
-+       return 0;
-+}
-+
-+static struct fb_ops cursorfb_ops = {
-+       .owner                  = THIS_MODULE,
-+       .fb_check_var           = cursorfb_check_var,
-+       .fb_set_par             = cursorfb_set_par,
-+       .fb_blank               = cursorfb_blank,
-+       .fb_fillrect            = cfb_fillrect,
-+       .fb_copyarea            = cfb_copyarea,
-+       .fb_imageblit           = cfb_imageblit,
-+       .fb_setcolreg           = cursorfb_setcolreg,
-+};
-+
-+static struct overlayfb_info * __init overlay1fb_init_fbinfo(void)
-+{
-+       struct overlayfb_info *fbi;
-+
-+       fbi = kmalloc(sizeof(struct overlayfb_info) + sizeof(u16) * 16, GFP_KERNEL);
-+       if (!fbi)
-+               return NULL;
-+
-+       memset(fbi, 0, sizeof(struct overlayfb_info) );
-+
-+       fbi->refcount = 0;
-+       init_MUTEX(&fbi->mutex);
-+
-+       strcpy(fbi->fb.fix.id, "overlay1");
-+
-+       fbi->fb.fix.type                = FB_TYPE_PACKED_PIXELS;
-+       fbi->fb.fix.type_aux            = 0;
-+       fbi->fb.fix.xpanstep            = 0;
-+       fbi->fb.fix.ypanstep            = 0;
-+       fbi->fb.fix.ywrapstep           = 0;
-+       fbi->fb.fix.accel               = FB_ACCEL_NONE;
-+
-+       fbi->fb.var.nonstd              = 0;
-+       fbi->fb.var.activate            = FB_ACTIVATE_NOW;
-+       fbi->fb.var.height              = -1;
-+       fbi->fb.var.width               = -1;
-+       fbi->fb.var.accel_flags = 0;
-+       fbi->fb.var.vmode               = FB_VMODE_NONINTERLACED;
-+
-+
-+       fbi->fb.fbops                   = &overlay1fb_ops;
-+       fbi->fb.flags                   = FBINFO_FLAG_DEFAULT;
-+       fbi->fb.node                    = -1;
-+       fbi->fb.pseudo_palette          = NULL;
-+
-+       fbi->xpos                       = 0;
-+       fbi->ypos                       = 0;
-+       fbi->format                     = -1;
-+       fbi->state                      = C_DISABLE;
-+
-+       return fbi;
-+}
-+
-+static struct overlayfb_info * __init overlay2fb_init_fbinfo(void)
-+{
-+       struct overlayfb_info *fbi;
-+
-+       fbi = kmalloc(sizeof(struct overlayfb_info) + sizeof(u16) * 16, GFP_KERNEL);
-+       if (!fbi)
-+               return NULL;
-+
-+       memset(fbi, 0, sizeof(struct overlayfb_info) );
-+
-+       fbi->refcount = 0;
-+       init_MUTEX(&fbi->mutex);
-+
-+       strcpy(fbi->fb.fix.id, "overlay2");
-+
-+       fbi->fb.fix.type                = FB_TYPE_PACKED_PIXELS;
-+       fbi->fb.fix.type_aux            = 0;
-+       fbi->fb.fix.xpanstep            = 0;
-+       fbi->fb.fix.ypanstep            = 0;
-+       fbi->fb.fix.ywrapstep           = 0;
-+       fbi->fb.fix.accel               = FB_ACCEL_NONE;
-+
-+       fbi->fb.var.nonstd              = 0;
-+       fbi->fb.var.activate            = FB_ACTIVATE_NOW;
-+       fbi->fb.var.height              = -1;
-+       fbi->fb.var.width               = -1;
-+       fbi->fb.var.accel_flags         = 0;
-+       fbi->fb.var.vmode               = FB_VMODE_NONINTERLACED;
-+
-+       fbi->fb.fbops                   = &overlay2fb_ops;
-+       fbi->fb.flags                   = FBINFO_FLAG_DEFAULT;
-+       fbi->fb.node                    = -1;
-+       fbi->fb.pseudo_palette          = NULL;
-+
-+       fbi->xpos                       = 0;
-+       fbi->ypos                       = 0;
-+       fbi->format                     = -1;
-+       fbi->state                      = C_DISABLE;
-+
-+       return fbi;
-+}
-+
-+static struct overlayfb_info * __init cursorfb_init_fbinfo(void)
-+{
-+       struct overlayfb_info *fbi;
-+
-+       fbi = kmalloc(sizeof(struct overlayfb_info) + sizeof(u16) * 16, GFP_KERNEL);
-+       if (!fbi)
-+               return NULL;
-+
-+       memset(fbi, 0, sizeof(struct overlayfb_info) );
-+
-+       fbi->refcount = 0;
-+       init_MUTEX(&fbi->mutex);
-+
-+       strcpy(fbi->fb.fix.id, "cursor");
-+
-+       fbi->fb.fix.type                = FB_TYPE_PACKED_PIXELS;
-+       fbi->fb.fix.type_aux            = 0;
-+       fbi->fb.fix.xpanstep            = 0;
-+       fbi->fb.fix.ypanstep            = 0;
-+       fbi->fb.fix.ywrapstep           = 0;
-+       fbi->fb.fix.accel               = FB_ACCEL_NONE;
-+
-+       fbi->fb.var.nonstd              = 0;
-+       fbi->fb.var.activate            = FB_ACTIVATE_NOW;
-+       fbi->fb.var.height              = -1;
-+       fbi->fb.var.width               = -1;
-+       fbi->fb.var.accel_flags         = 0;
-+       fbi->fb.var.vmode               = FB_VMODE_NONINTERLACED;
-+
-+       fbi->fb.fbops                   = &cursorfb_ops;
-+       fbi->fb.flags                   = FBINFO_FLAG_DEFAULT;
-+       fbi->fb.node                    = -1;
-+       fbi->fb.pseudo_palette          = NULL;
-+
-+
-+       fbi->xpos                       = 0;
-+       fbi->ypos                       = 0;
-+       fbi->format                     = -1;
-+       fbi->state                      = C_DISABLE;
-+
-+       return fbi;
-+}
-+
-+
-+void pxa_set_overlay_ctrlr_state(struct pxafb_info *fbi, u_int state)
-+{
-+       switch (state) {
-+       case C_DISABLE:
-+                       DISABLE_OVERLAYS(fbi);
-+                       break;
-+       case C_ENABLE:
-+                       ENABLE_OVERLAYS(fbi);
-+                       break;
-+       case C_BLANK:
-+                       BLANK_OVERLAYS(fbi);
-+                       break;
-+       case C_UNBLANK:
-+                       UNBLANK_OVERLAYS(fbi);
-+                       break;
-+       default:
-+                       break;
-+       }
-+}
-+
-+static int is_pxafb_device(struct device * dev, void * data)
-+{
-+       struct platform_device *pdev = container_of(dev, struct platform_device, dev);
-+
-+       return (strncmp(pdev->name, "pxa2xx-fb", 9) == 0);
-+}
-+
-+static int __devinit pxafb_overlay_init(void)
-+{
-+       int ret;
-+       struct overlayfb_info *overlay1fb, *overlay2fb, *cursorfb;
-+       struct pxafb_info *fbi;
-+       struct device *dev;
-+
-+       ret = -1;
-+       overlay1fb = overlay2fb = cursorfb = NULL;
-+       fbi = NULL;
-+
-+       dev = bus_find_device(&platform_bus_type, NULL, NULL, is_pxafb_device);
-+       if (!dev) {
-+               printk(KERN_INFO "Base framebuffer not exists, failed to load overlay driver!\n");
-+               return ret;
-+       }
-+
-+       fbi = dev_get_drvdata(dev);
-+       if (fbi == NULL) {
-+               printk(KERN_INFO "Base framebuffer not initialized, failed to load overlay driver!\n");
-+               return ret;
-+       }
-+
-+       /* Overlay 1 windows */
-+       overlay1fb = overlay1fb_init_fbinfo();
-+
-+       if (!overlay1fb) {
-+               ret = -ENOMEM;
-+               printk("overlay1fb_init_fbinfo failed\n");
-+               goto failed;
-+       }
-+
-+       ret = register_framebuffer(&overlay1fb->fb);
-+       if (ret < 0)
-+               goto failed;
-+
-+       /* Overlay 2 window */
-+       overlay2fb = overlay2fb_init_fbinfo();
-+
-+       if (!overlay2fb) {
-+               ret = -ENOMEM;
-+               printk("overlay2fb_init_fbinfo failed\n");
-+               goto failed;
-+       }
-+
-+       ret = register_framebuffer(&overlay2fb->fb);
-+       if (ret < 0) goto failed;
-+
-+       /* Hardware cursor window */
-+       cursorfb = cursorfb_init_fbinfo();
-+
-+       if (!cursorfb) {
-+               ret = -ENOMEM;
-+               printk("cursorfb_init_fbinfo failed\n");
-+               goto failed;
-+       }
-+
-+       ret = register_framebuffer(&cursorfb->fb);
-+       if (ret < 0) goto failed;
-+
-+
-+       /* set refernce to Overlays  */
-+       fbi->overlay1fb  = overlay1fb;
-+       fbi->overlay2fb  = overlay2fb;
-+       fbi->cursorfb    = cursorfb;
-+       fbi->set_overlay_ctrlr_state=pxa_set_overlay_ctrlr_state;
-+
-+       /* set refernce to BaseFrame */
-+       overlay1fb->basefb = fbi;
-+       overlay2fb->basefb = fbi;
-+       cursorfb->basefb = fbi;
-+
-+       printk(KERN_INFO "Load PXA Overlay driver successfully!\n");
-+
-+       return 0;
-+
-+failed:
-+       if (overlay1fb)
-+               kfree(overlay1fb);
-+       if (overlay2fb)
-+               kfree(overlay2fb);
-+       if (cursorfb)
-+               kfree(cursorfb);
-+       printk(KERN_INFO "Load PXA Overlay driver failed!\n");
-+       return ret;
-+}
-+
-+static void __exit pxafb_overlay_exit(void)
-+{
-+       struct pxafb_info *fbi;
-+       struct device *dev;
-+
-+       dev = bus_find_device(&platform_bus_type, NULL, NULL, is_pxafb_device);
-+       if (!dev)
-+               return;
-+
-+       fbi = dev_get_drvdata(dev);
-+       if (!fbi)
-+               return;
-+
-+       if (fbi->overlay1fb) {
-+               unregister_framebuffer(&(fbi->overlay1fb->fb));
-+               kfree(fbi->overlay1fb);
-+               fbi->overlay1fb  = NULL;
-+       }
-+
-+       if (fbi->overlay2fb) {
-+               unregister_framebuffer(&(fbi->overlay2fb->fb));
-+               kfree(fbi->overlay2fb);
-+               fbi->overlay2fb  = NULL;
-+       }
-+
-+       if (fbi->cursorfb) {
-+               unregister_framebuffer(&(fbi->cursorfb->fb));
-+               kfree(fbi->cursorfb);
-+               fbi->cursorfb  = NULL;
-+       }
-+
-+       fbi->set_overlay_ctrlr_state = NULL;
-+
-+       printk(KERN_INFO "Unload PXA Overlay driver successfully!\n");
-+       return;
-+}
-+
-+
-+module_init(pxafb_overlay_init);
-+module_exit(pxafb_overlay_exit);
-+
-+MODULE_DESCRIPTION("Loadable framebuffer overlay driver for PXA");
-+MODULE_LICENSE("GPL");
-+
---- linux-2.6.24-rc1.orig/include/asm-arm/arch-pxa/pxa-regs.h
-+++ linux-2.6.24-rc1/include/asm-arm/arch-pxa/pxa-regs.h
-@@ -789,11 +789,18 @@
- #define UDC_INT_PACKETCMP  (0x1)
- 
- #define UDCICR_INT(n,intr) (((intr) & 0x03) << (((n) & 0x0F) * 2))
-+/* Older defines, do not use. */
- #define UDCICR1_IECC   (1 << 31)       /* IntEn - Configuration Change */
- #define UDCICR1_IESOF  (1 << 30)       /* IntEn - Start of Frame */
- #define UDCICR1_IERU   (1 << 29)       /* IntEn - Resume */
- #define UDCICR1_IESU   (1 << 28)       /* IntEn - Suspend */
- #define UDCICR1_IERS   (1 << 27)       /* IntEn - Reset */
-+/* New defines. */
-+#define UDCISR1_IRCC   (1 << 31)       /* IntEn - Configuration Change */
-+#define UDCISR1_IRSOF  (1 << 30)       /* IntEn - Start of Frame */
-+#define UDCISR1_IRRU   (1 << 29)       /* IntEn - Resume */
-+#define UDCISR1_IRSU   (1 << 28)       /* IntEn - Suspend */
-+#define UDCISR1_IRRS   (1 << 27)       /* IntEn - Reset */
- 
- #define UDCISR0         __REG(0x4060000C) /* UDC Interrupt Status Register 0 */
- #define UDCISR1         __REG(0x40600010) /* UDC Interrupt Status Register 1 */
-@@ -1827,6 +1834,8 @@
- #define DFBR0          __REG(0x44000020)  /* DMA Channel 0 Frame Branch Register */
- #define DFBR1          __REG(0x44000024)  /* DMA Channel 1 Frame Branch Register */
- #define LCSR           __REG(0x44000038)  /* LCD Controller Status Register */
-+#define LCSR0          __REG(0x44000038)  /* LCD Controller Status Register */
-+#define LCSR1          __REG(0x44000034)  /* LCD Controller Status Register */
- #define LIIDR          __REG(0x4400003C)  /* LCD Controller Interrupt ID Register */
- #define TMEDRGBR       __REG(0x44000040)  /* TMED RGB Seed Register */
- #define TMEDCR         __REG(0x44000044)  /* TMED Control Register */
-@@ -1836,6 +1845,10 @@
- #define LCCR3_4BPP (2 << 24)
- #define LCCR3_8BPP (3 << 24)
- #define LCCR3_16BPP (4 << 24)
-+#define LCCR3_18BPP (6 << 24)
-+#define LCCR3_19BPP (8 << 24)
-+#define LCCR3_24BPP (9 << 24)
-+#define LCCR3_25BPP (10<< 24)
- 
- #define LCCR3_PDFOR_0 (0 << 30)
- #define LCCR3_PDFOR_1 (1 << 30)
-@@ -2010,6 +2023,104 @@
- 
- #define LDCMD_PAL      (1 << 26)       /* instructs DMA to load palette buffer */
- 
-+/* Overlay1 & Overlay2 & Hardware Cursor */
-+#define LCSR1_SOF1     (1 << 0)
-+#define LCSR1_SOF2     (1 << 1)
-+#define LCSR1_SOF3     (1 << 2)
-+#define LCSR1_SOF4     (1 << 3)
-+#define LCSR1_SOF5     (1 << 4)
-+#define LCSR1_SOF6     (1 << 5)
-+
-+#define LCSR1_EOF1     (1 << 8)
-+#define LCSR1_EOF2     (1 << 9)
-+#define LCSR1_EOF3     (1 << 10)
-+#define LCSR1_EOF4     (1 << 11)
-+#define LCSR1_EOF5     (1 << 12)
-+#define LCSR1_EOF6     (1 << 13)
-+
-+#define LCSR1_BS1      (1 << 16)
-+#define LCSR1_BS2      (1 << 17)
-+#define LCSR1_BS3      (1 << 18)
-+#define LCSR1_BS4      (1 << 19)
-+#define LCSR1_BS5      (1 << 20)
-+#define LCSR1_BS6      (1 << 21)
-+
-+#define LCSR1_IU2      (1 << 25)
-+#define LCSR1_IU3      (1 << 26)
-+#define LCSR1_IU4      (1 << 27)
-+#define LCSR1_IU5      (1 << 28)
-+#define LCSR1_IU6      (1 << 29)
-+
-+#define LDCMD_SOFINT   (1 << 22)
-+#define LDCMD_EOFINT   (1 << 21)
-+
-+
-+#define LCCR5_SOFM1    (1<<0)          /* Start Of Frame Mask for Overlay 1 (channel 1) */
-+#define LCCR5_SOFM2    (1<<1)          /* Start Of Frame Mask for Overlay 2 (channel 2) */
-+#define LCCR5_SOFM3    (1<<2)          /* Start Of Frame Mask for Overlay 2 (channel 3) */
-+#define LCCR5_SOFM4    (1<<3)          /* Start Of Frame Mask for Overlay 2 (channel 4) */
-+#define LCCR5_SOFM5    (1<<4)          /* Start Of Frame Mask for cursor (channel 5) */
-+#define LCCR5_SOFM6    (1<<5)          /* Start Of Frame Mask for command data (channel 6) */
-+
-+#define LCCR5_EOFM1    (1<<8)          /* End Of Frame Mask for Overlay 1 (channel 1) */
-+#define LCCR5_EOFM2    (1<<9)          /* End Of Frame Mask for Overlay 2 (channel 2) */
-+#define LCCR5_EOFM3    (1<<10)         /* End Of Frame Mask for Overlay 2 (channel 3) */
-+#define LCCR5_EOFM4    (1<<11)         /* End Of Frame Mask for Overlay 2 (channel 4) */
-+#define LCCR5_EOFM5    (1<<12)         /* End Of Frame Mask for cursor (channel 5) */
-+#define LCCR5_EOFM6    (1<<13)         /* End Of Frame Mask for command data (channel 6) */
-+
-+#define LCCR5_BSM1     (1<<16)         /* Branch mask for Overlay 1 (channel 1) */
-+#define LCCR5_BSM2     (1<<17)         /* Branch mask for Overlay 2 (channel 2) */
-+#define LCCR5_BSM3     (1<<18)         /* Branch mask for Overlay 2 (channel 3) */
-+#define LCCR5_BSM4     (1<<19)         /* Branch mask for Overlay 2 (channel 4) */
-+#define LCCR5_BSM5     (1<<20)         /* Branch mask for cursor (channel 5) */
-+#define LCCR5_BSM6     (1<<21)         /* Branch mask for data command  (channel 6) */
-+
-+#define LCCR5_IUM1     (1<<24)         /* Input FIFO Underrun Mask for Overlay 1  */
-+#define LCCR5_IUM2     (1<<25)         /* Input FIFO Underrun Mask for Overlay 2  */
-+#define LCCR5_IUM3     (1<<26)         /* Input FIFO Underrun Mask for Overlay 2  */
-+#define LCCR5_IUM4     (1<<27)         /* Input FIFO Underrun Mask for Overlay 2  */
-+#define LCCR5_IUM5     (1<<28)         /* Input FIFO Underrun Mask for cursor */
-+#define LCCR5_IUM6     (1<<29)         /* Input FIFO Underrun Mask for data command */
-+
-+#define OVL1C1_O1EN    (1<<31)         /* Enable bit for Overlay 1 */
-+#define OVL2C1_O2EN    (1<<31)         /* Enable bit for Overlay 2 */
-+#define CCR_CEN                (1<<31)         /* Enable bit for Cursor */
-+
-+/* LCD registers */
-+#define LCCR4          __REG(0x44000010)  /* LCD Controller Control Register 4 */
-+#define LCCR5          __REG(0x44000014)  /* LCD Controller Control Register 5 */
-+#define FBR0           __REG(0x44000020)  /* DMA Channel 0 Frame Branch Register */
-+#define FBR1           __REG(0x44000024)  /* DMA Channel 1 Frame Branch Register */
-+#define FBR2           __REG(0x44000028)  /* DMA Channel 2 Frame Branch Register */
-+#define FBR3           __REG(0x4400002C)  /* DMA Channel 3 Frame Branch Register */
-+#define FBR4           __REG(0x44000030)  /* DMA Channel 4 Frame Branch Register */
-+#define FDADR2         __REG(0x44000220)  /* DMA Channel 2 Frame Descriptor Address Register */
-+#define FSADR2         __REG(0x44000224)  /* DMA Channel 2 Frame Source Address Register */
-+#define FIDR2          __REG(0x44000228)  /* DMA Channel 2 Frame ID Register */
-+#define LDCMD2         __REG(0x4400022C)  /* DMA Channel 2 Command Register */
-+#define FDADR3         __REG(0x44000230)  /* DMA Channel 3 Frame Descriptor Address Register */
-+#define FSADR3         __REG(0x44000234)  /* DMA Channel 3 Frame Source Address Register */
-+#define FIDR3          __REG(0x44000238)  /* DMA Channel 3 Frame ID Register */
-+#define LDCMD3         __REG(0x4400023C)  /* DMA Channel 3 Command Register */
-+#define FDADR4         __REG(0x44000240)  /* DMA Channel 4 Frame Descriptor Address Register */
-+#define FSADR4         __REG(0x44000244)  /* DMA Channel 4 Frame Source Address Register */
-+#define FIDR4          __REG(0x44000248)  /* DMA Channel 4 Frame ID Register */
-+#define LDCMD4         __REG(0x4400024C)  /* DMA Channel 4 Command Register */
-+#define FDADR5         __REG(0x44000250)  /* DMA Channel 5 Frame Descriptor Address Register */
-+#define FSADR5         __REG(0x44000254)  /* DMA Channel 5 Frame Source Address Register */
-+#define FIDR5          __REG(0x44000258)  /* DMA Channel 5 Frame ID Register */
-+#define LDCMD5         __REG(0x4400025C)  /* DMA Channel 5 Command Register */
-+
-+#define OVL1C1         __REG(0x44000050)  /* Overlay 1 Control Register 1 */
-+#define OVL1C2         __REG(0x44000060)  /* Overlay 1 Control Register 2 */
-+#define OVL2C1         __REG(0x44000070)  /* Overlay 2 Control Register 1 */
-+#define OVL2C2         __REG(0x44000080)  /* Overlay 2 Control Register 2 */
-+#define CCR            __REG(0x44000090)  /* Cursor Control Register */
-+
-+#define FBR5           __REG(0x44000110)  /* DMA Channel 5 Frame Branch Register */
-+#define FBR6           __REG(0x44000114)  /* DMA Channel 6 Frame Branch Register */
-+
- /*
-  * Memory controller
-  */
diff --git a/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/squashfs3.0-2.6.15.patch b/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/squashfs3.0-2.6.15.patch
deleted file mode 100644
index a210afcaf8..0000000000
--- a/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/squashfs3.0-2.6.15.patch
+++ /dev/null
@@ -1,4189 +0,0 @@
- fs/Kconfig                     |   65 +
- fs/Makefile                    |    1 
- fs/squashfs/Makefile           |    7 
- fs/squashfs/inode.c            | 2122 +++++++++++++++++++++++++++++++++++++++++
- fs/squashfs/squashfs.h         |   86 +
- fs/squashfs/squashfs2_0.c      |  757 ++++++++++++++
- include/linux/squashfs_fs.h    |  911 +++++++++++++++++
- include/linux/squashfs_fs_i.h  |   45 
- include/linux/squashfs_fs_sb.h |   74 +
- init/do_mounts_rd.c            |   13 
- 10 files changed, 4081 insertions(+)
-
-Index: linux-2.6.22/fs/Kconfig
-===================================================================
---- linux-2.6.22.orig/fs/Kconfig        2007-08-28 21:56:32.000000000 +0100
-+++ linux-2.6.22/fs/Kconfig     2007-08-28 21:56:34.000000000 +0100
-@@ -1394,6 +1394,71 @@ config CRAMFS
- 
-          If unsure, say N.
- 
-+config SQUASHFS
-+       tristate "SquashFS 3.0 - Squashed file system support"
-+       select ZLIB_INFLATE
-+       help
-+         Saying Y here includes support for SquashFS 3.0 (a Compressed Read-Only File
-+         System).  Squashfs is a highly compressed read-only filesystem for Linux.
-+         It uses zlib compression to compress both files, inodes and directories.
-+         Inodes in the system are very small and all blocks are packed to minimise
-+         data overhead. Block sizes greater than 4K are supported up to a maximum of 64K.
-+         SquashFS 3.0 supports 64 bit filesystems and files (larger than 4GB), full
-+         uid/gid information, hard links and timestamps.
-+
-+         Squashfs is intended for general read-only filesystem use, for archival
-+         use (i.e. in cases where a .tar.gz file may be used), and in embedded
-+         systems where low overhead is needed.  Further information and filesystem tools
-+         are available from http://squashfs.sourceforge.net.
-+
-+         If you want to compile this as a module ( = code which can be
-+         inserted in and removed from the running kernel whenever you want),
-+         say M here and read <file:Documentation/modules.txt>.  The module
-+         will be called squashfs.  Note that the root file system (the one
-+         containing the directory /) cannot be compiled as a module.
-+
-+         If unsure, say N.
-+
-+config SQUASHFS_EMBEDDED
-+
-+       bool "Additional options for memory-constrained systems" 
-+       depends on SQUASHFS
-+       default n
-+       help
-+         Saying Y here allows you to specify cache sizes and how Squashfs
-+         allocates memory.  This is only intended for memory constrained
-+         systems.
-+
-+         If unsure, say N.
-+
-+config SQUASHFS_FRAGMENT_CACHE_SIZE
-+       int "Number of fragments cached" if SQUASHFS_EMBEDDED
-+       depends on SQUASHFS
-+       default "3"
-+       help
-+         By default SquashFS caches the last 3 fragments read from
-+         the filesystem.  Increasing this amount may mean SquashFS
-+         has to re-read fragments less often from disk, at the expense
-+         of extra system memory.  Decreasing this amount will mean
-+         SquashFS uses less memory at the expense of extra reads from disk.
-+
-+         Note there must be at least one cached fragment.  Anything
-+         much more than three will probably not make much difference.
-+
-+config SQUASHFS_VMALLOC
-+       bool "Use Vmalloc rather than Kmalloc" if SQUASHFS_EMBEDDED
-+       depends on SQUASHFS
-+       default n
-+       help
-+         By default SquashFS uses kmalloc to obtain fragment cache memory.
-+         Kmalloc memory is the standard kernel allocator, but it can fail
-+         on memory constrained systems.  Because of the way Vmalloc works,
-+         Vmalloc can succeed when kmalloc fails.  Specifying this option
-+         will make SquashFS always use Vmalloc to allocate the
-+         fragment cache memory.
-+
-+         If unsure, say N.
-+
- config VXFS_FS
-        tristate "FreeVxFS file system support (VERITAS VxFS(TM) compatible)"
-        depends on BLOCK
-Index: linux-2.6.22/fs/Makefile
-===================================================================
---- linux-2.6.22.orig/fs/Makefile       2007-08-28 21:54:14.000000000 +0100
-+++ linux-2.6.22/fs/Makefile    2007-08-28 21:56:34.000000000 +0100
-@@ -72,6 +72,7 @@ obj-$(CONFIG_JBD)             += jbd/
- obj-$(CONFIG_JBD2)             += jbd2/
- obj-$(CONFIG_EXT2_FS)          += ext2/
- obj-$(CONFIG_CRAMFS)           += cramfs/
-+obj-$(CONFIG_SQUASHFS)         += squashfs/
- obj-$(CONFIG_RAMFS)            += ramfs/
- obj-$(CONFIG_HUGETLBFS)                += hugetlbfs/
- obj-$(CONFIG_CODA_FS)          += coda/
-Index: linux-2.6.22/fs/squashfs/inode.c
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/fs/squashfs/inode.c    2007-08-28 22:12:03.000000000 +0100
-@@ -0,0 +1,2122 @@
-+/*
-+ * Squashfs - a compressed read only filesystem for Linux
-+ *
-+ * Copyright (c) 2002, 2003, 2004, 2005, 2006
-+ * Phillip Lougher <phillip@lougher.org.uk>
-+ *
-+ * 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,
-+ * 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, 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
-+ *
-+ * inode.c
-+ */
-+
-+#include <linux/types.h>
-+#include <linux/squashfs_fs.h>
-+#include <linux/module.h>
-+#include <linux/errno.h>
-+#include <linux/slab.h>
-+#include <linux/fs.h>
-+#include <linux/smp_lock.h>
-+#include <linux/slab.h>
-+#include <linux/squashfs_fs_sb.h>
-+#include <linux/squashfs_fs_i.h>
-+#include <linux/buffer_head.h>
-+#include <linux/vfs.h>
-+#include <linux/init.h>
-+#include <linux/dcache.h>
-+#include <linux/wait.h>
-+#include <linux/zlib.h>
-+#include <linux/blkdev.h>
-+#include <linux/vmalloc.h>
-+#include <asm/uaccess.h>
-+#include <asm/semaphore.h>
-+
-+#include "squashfs.h"
-+
-+static void squashfs_put_super(struct super_block *);
-+static int squashfs_statfs(struct dentry *, struct kstatfs *);
-+static int squashfs_symlink_readpage(struct file *file, struct page *page);
-+static int squashfs_readpage(struct file *file, struct page *page);
-+static int squashfs_readpage4K(struct file *file, struct page *page);
-+static int squashfs_readdir(struct file *, void *, filldir_t);
-+static struct inode *squashfs_alloc_inode(struct super_block *sb);
-+static void squashfs_destroy_inode(struct inode *inode);
-+static int init_inodecache(void);
-+static void destroy_inodecache(void);
-+static struct dentry *squashfs_lookup(struct inode *, struct dentry *,
-+                               struct nameidata *);
-+static struct inode *squashfs_iget(struct super_block *s, squashfs_inode_t inode);
-+static long long read_blocklist(struct inode *inode, int index,
-+                               int readahead_blks, char *block_list,
-+                               unsigned short **block_p, unsigned int *bsize);
-+static int squashfs_get_sb(struct file_system_type *, int,
-+                               const char *, void *, struct vfsmount *);
-+
-+
-+static z_stream stream;
-+
-+static struct file_system_type squashfs_fs_type = {
-+       .owner = THIS_MODULE,
-+       .name = "squashfs",
-+       .get_sb = squashfs_get_sb,
-+       .kill_sb = kill_block_super,
-+       .fs_flags = FS_REQUIRES_DEV
-+};
-+
-+static unsigned char squashfs_filetype_table[] = {
-+       DT_UNKNOWN, DT_DIR, DT_REG, DT_LNK, DT_BLK, DT_CHR, DT_FIFO, DT_SOCK
-+};
-+
-+static struct super_operations squashfs_ops = {
-+       .alloc_inode = squashfs_alloc_inode,
-+       .destroy_inode = squashfs_destroy_inode,
-+       .statfs = squashfs_statfs,
-+       .put_super = squashfs_put_super,
-+};
-+
-+SQSH_EXTERN struct address_space_operations squashfs_symlink_aops = {
-+       .readpage = squashfs_symlink_readpage
-+};
-+
-+SQSH_EXTERN struct address_space_operations squashfs_aops = {
-+       .readpage = squashfs_readpage
-+};
-+
-+SQSH_EXTERN struct address_space_operations squashfs_aops_4K = {
-+       .readpage = squashfs_readpage4K
-+};
-+
-+static struct file_operations squashfs_dir_ops = {
-+       .read = generic_read_dir,
-+       .readdir = squashfs_readdir
-+};
-+
-+SQSH_EXTERN struct inode_operations squashfs_dir_inode_ops = {
-+       .lookup = squashfs_lookup
-+};
-+
-+
-+static struct buffer_head *get_block_length(struct super_block *s,
-+                               int *cur_index, int *offset, int *c_byte)
-+{
-+       struct squashfs_sb_info *msblk = s->s_fs_info;
-+       unsigned short temp;
-+       struct buffer_head *bh;
-+
-+       if (!(bh = sb_bread(s, *cur_index)))
-+               goto out;
-+
-+       if (msblk->devblksize - *offset == 1) {
-+               if (msblk->swap)
-+                       ((unsigned char *) &temp)[1] = *((unsigned char *)
-+                               (bh->b_data + *offset));
-+               else
-+                       ((unsigned char *) &temp)[0] = *((unsigned char *)
-+                               (bh->b_data + *offset));
-+               brelse(bh);
-+               if (!(bh = sb_bread(s, ++(*cur_index))))
-+                       goto out;
-+               if (msblk->swap)
-+                       ((unsigned char *) &temp)[0] = *((unsigned char *)
-+                               bh->b_data); 
-+               else
-+                       ((unsigned char *) &temp)[1] = *((unsigned char *)
-+                               bh->b_data); 
-+               *c_byte = temp;
-+               *offset = 1;
-+       } else {
-+               if (msblk->swap) {
-+                       ((unsigned char *) &temp)[1] = *((unsigned char *)
-+                               (bh->b_data + *offset));
-+                       ((unsigned char *) &temp)[0] = *((unsigned char *)
-+                               (bh->b_data + *offset + 1)); 
-+               } else {
-+                       ((unsigned char *) &temp)[0] = *((unsigned char *)
-+                               (bh->b_data + *offset));
-+                       ((unsigned char *) &temp)[1] = *((unsigned char *)
-+                               (bh->b_data + *offset + 1)); 
-+               }
-+               *c_byte = temp;
-+               *offset += 2;
-+       }
-+
-+       if (SQUASHFS_CHECK_DATA(msblk->sblk.flags)) {
-+               if (*offset == msblk->devblksize) {
-+                       brelse(bh);
-+                       if (!(bh = sb_bread(s, ++(*cur_index))))
-+                               goto out;
-+                       *offset = 0;
-+               }
-+               if (*((unsigned char *) (bh->b_data + *offset)) !=
-+                                               SQUASHFS_MARKER_BYTE) {
-+                       ERROR("Metadata block marker corrupt @ %x\n",
-+                                               *cur_index);
-+                       brelse(bh);
-+                       goto out;
-+               }
-+               (*offset)++;
-+       }
-+       return bh;
-+
-+out:
-+       return NULL;
-+}
-+
-+
-+SQSH_EXTERN unsigned int squashfs_read_data(struct super_block *s, char *buffer,
-+                       long long index, unsigned int length,
-+                       long long *next_index)
-+{
-+       struct squashfs_sb_info *msblk = s->s_fs_info;
-+       struct buffer_head *bh[((SQUASHFS_FILE_MAX_SIZE - 1) >>
-+                       msblk->devblksize_log2) + 2];
-+       unsigned int offset = index & ((1 << msblk->devblksize_log2) - 1);
-+       unsigned int cur_index = index >> msblk->devblksize_log2;
-+       int bytes, avail_bytes, b = 0, k;
-+       char *c_buffer;
-+       unsigned int compressed;
-+       unsigned int c_byte = length;
-+
-+       if (c_byte) {
-+               bytes = msblk->devblksize - offset;
-+               compressed = SQUASHFS_COMPRESSED_BLOCK(c_byte);
-+               c_buffer = compressed ? msblk->read_data : buffer;
-+               c_byte = SQUASHFS_COMPRESSED_SIZE_BLOCK(c_byte);
-+
-+               TRACE("Block @ 0x%llx, %scompressed size %d\n", index, compressed
-+                                       ? "" : "un", (unsigned int) c_byte);
-+
-+               if (!(bh[0] = sb_getblk(s, cur_index)))
-+                       goto block_release;
-+
-+               for (b = 1; bytes < c_byte; b++) {
-+                       if (!(bh[b] = sb_getblk(s, ++cur_index)))
-+                               goto block_release;
-+                       bytes += msblk->devblksize;
-+               }
-+               ll_rw_block(READ, b, bh);
-+       } else {
-+               if (!(bh[0] = get_block_length(s, &cur_index, &offset,
-+                                                               &c_byte)))
-+                       goto read_failure;
-+
-+               bytes = msblk->devblksize - offset;
-+               compressed = SQUASHFS_COMPRESSED(c_byte);
-+               c_buffer = compressed ? msblk->read_data : buffer;
-+               c_byte = SQUASHFS_COMPRESSED_SIZE(c_byte);
-+
-+               TRACE("Block @ 0x%llx, %scompressed size %d\n", index, compressed
-+                                       ? "" : "un", (unsigned int) c_byte);
-+
-+               for (b = 1; bytes < c_byte; b++) {
-+                       if (!(bh[b] = sb_getblk(s, ++cur_index)))
-+                               goto block_release;
-+                       bytes += msblk->devblksize;
-+               }
-+               ll_rw_block(READ, b - 1, bh + 1);
-+       }
-+
-+       if (compressed)
-+               down(&msblk->read_data_mutex);
-+
-+       for (bytes = 0, k = 0; k < b; k++) {
-+               avail_bytes = (c_byte - bytes) > (msblk->devblksize - offset) ?
-+                                       msblk->devblksize - offset :
-+                                       c_byte - bytes;
-+               wait_on_buffer(bh[k]);
-+               if (!buffer_uptodate(bh[k]))
-+                       goto block_release;
-+               memcpy(c_buffer + bytes, bh[k]->b_data + offset, avail_bytes);
-+               bytes += avail_bytes;
-+               offset = 0;
-+               brelse(bh[k]);
-+       }
-+
-+       /*
-+        * uncompress block
-+        */
-+       if (compressed) {
-+               int zlib_err;
-+
-+               stream.next_in = c_buffer;
-+               stream.avail_in = c_byte;
-+               stream.next_out = buffer;
-+               stream.avail_out = msblk->read_size;
-+
-+               if (((zlib_err = zlib_inflateInit(&stream)) != Z_OK) ||
-+                               ((zlib_err = zlib_inflate(&stream, Z_FINISH))
-+                                != Z_STREAM_END) || ((zlib_err =
-+                               zlib_inflateEnd(&stream)) != Z_OK)) {
-+                       ERROR("zlib_fs returned unexpected result 0x%x\n",
-+                               zlib_err);
-+                       bytes = 0;
-+               } else
-+                       bytes = stream.total_out;
-+               
-+               up(&msblk->read_data_mutex);
-+       }
-+
-+       if (next_index)
-+               *next_index = index + c_byte + (length ? 0 :
-+                               (SQUASHFS_CHECK_DATA(msblk->sblk.flags)
-+                                ? 3 : 2));
-+       return bytes;
-+
-+block_release:
-+       while (--b >= 0)
-+               brelse(bh[b]);
-+
-+read_failure:
-+       ERROR("sb_bread failed reading block 0x%x\n", cur_index);
-+       return 0;
-+}
-+
-+
-+SQSH_EXTERN int squashfs_get_cached_block(struct super_block *s, char *buffer,
-+                               long long block, unsigned int offset,
-+                               int length, long long *next_block,
-+                               unsigned int *next_offset)
-+{
-+       struct squashfs_sb_info *msblk = s->s_fs_info;
-+       int n, i, bytes, return_length = length;
-+       long long next_index;
-+
-+       TRACE("Entered squashfs_get_cached_block [%llx:%x]\n", block, offset);
-+
-+       while ( 1 ) {
-+               for (i = 0; i < SQUASHFS_CACHED_BLKS; i++) 
-+                       if (msblk->block_cache[i].block == block)
-+                               break; 
-+               
-+               down(&msblk->block_cache_mutex);
-+
-+               if (i == SQUASHFS_CACHED_BLKS) {
-+                       /* read inode header block */
-+                       for (i = msblk->next_cache, n = SQUASHFS_CACHED_BLKS;
-+                                       n ; n --, i = (i + 1) %
-+                                       SQUASHFS_CACHED_BLKS)
-+                               if (msblk->block_cache[i].block !=
-+                                                       SQUASHFS_USED_BLK)
-+                                       break;
-+
-+                       if (n == 0) {
-+                               wait_queue_t wait;
-+
-+                               init_waitqueue_entry(&wait, current);
-+                               add_wait_queue(&msblk->waitq, &wait);
-+                               set_current_state(TASK_UNINTERRUPTIBLE);
-+                               up(&msblk->block_cache_mutex);
-+                               schedule();
-+                               set_current_state(TASK_RUNNING);
-+                               remove_wait_queue(&msblk->waitq, &wait);
-+                               continue;
-+                       }
-+                       msblk->next_cache = (i + 1) % SQUASHFS_CACHED_BLKS;
-+
-+                       if (msblk->block_cache[i].block ==
-+                                                       SQUASHFS_INVALID_BLK) {
-+                               if (!(msblk->block_cache[i].data =
-+                                               kmalloc(SQUASHFS_METADATA_SIZE,
-+                                               GFP_KERNEL))) {
-+                                       ERROR("Failed to allocate cache"
-+                                                       "block\n");
-+                                       up(&msblk->block_cache_mutex);
-+                                       goto out;
-+                               }
-+                       }
-+       
-+                       msblk->block_cache[i].block = SQUASHFS_USED_BLK;
-+                       up(&msblk->block_cache_mutex);
-+
-+                       if (!(msblk->block_cache[i].length =
-+                                               squashfs_read_data(s,
-+                                               msblk->block_cache[i].data,
-+                                               block, 0, &next_index))) {
-+                               ERROR("Unable to read cache block [%llx:%x]\n",
-+                                               block, offset);
-+                               goto out;
-+                       }
-+
-+                       down(&msblk->block_cache_mutex);
-+                       wake_up(&msblk->waitq);
-+                       msblk->block_cache[i].block = block;
-+                       msblk->block_cache[i].next_index = next_index;
-+                       TRACE("Read cache block [%llx:%x]\n", block, offset);
-+               }
-+
-+               if (msblk->block_cache[i].block != block) {
-+                       up(&msblk->block_cache_mutex);
-+                       continue;
-+               }
-+
-+               if ((bytes = msblk->block_cache[i].length - offset) >= length) {
-+                       if (buffer)
-+                               memcpy(buffer, msblk->block_cache[i].data +
-+                                               offset, length);
-+                       if (msblk->block_cache[i].length - offset == length) {
-+                               *next_block = msblk->block_cache[i].next_index;
-+                               *next_offset = 0;
-+                       } else {
-+                               *next_block = block;
-+                               *next_offset = offset + length;
-+                       }
-+                       up(&msblk->block_cache_mutex);
-+                       goto finish;
-+               } else {
-+                       if (buffer) {
-+                               memcpy(buffer, msblk->block_cache[i].data +
-+                                               offset, bytes);
-+                               buffer += bytes;
-+                       }
-+                       block = msblk->block_cache[i].next_index;
-+                       up(&msblk->block_cache_mutex);
-+                       length -= bytes;
-+                       offset = 0;
-+               }
-+       }
-+
-+finish:
-+       return return_length;
-+out:
-+       return 0;
-+}
-+
-+
-+static int get_fragment_location(struct super_block *s, unsigned int fragment,
-+                               long long *fragment_start_block,
-+                               unsigned int *fragment_size)
-+{
-+       struct squashfs_sb_info *msblk = s->s_fs_info;
-+       long long start_block =
-+               msblk->fragment_index[SQUASHFS_FRAGMENT_INDEX(fragment)];
-+       int offset = SQUASHFS_FRAGMENT_INDEX_OFFSET(fragment);
-+       struct squashfs_fragment_entry fragment_entry;
-+
-+       if (msblk->swap) {
-+               struct squashfs_fragment_entry sfragment_entry;
-+
-+               if (!squashfs_get_cached_block(s, (char *) &sfragment_entry,
-+                                       start_block, offset,
-+                                       sizeof(sfragment_entry), &start_block,
-+                                       &offset))
-+                       goto out;
-+               SQUASHFS_SWAP_FRAGMENT_ENTRY(&fragment_entry, &sfragment_entry);
-+       } else
-+               if (!squashfs_get_cached_block(s, (char *) &fragment_entry,
-+                                       start_block, offset,
-+                                       sizeof(fragment_entry), &start_block,
-+                                       &offset))
-+                       goto out;
-+
-+       *fragment_start_block = fragment_entry.start_block;
-+       *fragment_size = fragment_entry.size;
-+
-+       return 1;
-+
-+out:
-+       return 0;
-+}
-+
-+
-+SQSH_EXTERN void release_cached_fragment(struct squashfs_sb_info *msblk, struct
-+                                       squashfs_fragment_cache *fragment)
-+{
-+       down(&msblk->fragment_mutex);
-+       fragment->locked --;
-+       wake_up(&msblk->fragment_wait_queue);
-+       up(&msblk->fragment_mutex);
-+}
-+
-+
-+SQSH_EXTERN struct squashfs_fragment_cache *get_cached_fragment(struct super_block
-+                                       *s, long long start_block,
-+                                       int length)
-+{
-+       int i, n, nf;
-+       struct squashfs_sb_info *msblk = s->s_fs_info;
-+
-+       while ( 1 ) {
-+               down(&msblk->fragment_mutex);
-+
-+               for (i = 0; i < SQUASHFS_CACHED_FRAGMENTS &&
-+                               msblk->fragment[i].block != start_block; i++);
-+
-+               if (i == SQUASHFS_CACHED_FRAGMENTS) {
-+                       nf = (msblk->next_fragment + 1) % 
-+                               SQUASHFS_CACHED_FRAGMENTS;
-+                       for (i = msblk->next_fragment, n =
-+                               SQUASHFS_CACHED_FRAGMENTS; n &&
-+                               msblk->fragment[i].locked; n--, i = (i + 1) %
-+                               SQUASHFS_CACHED_FRAGMENTS);
-+
-+                       if (n == 0) {
-+                               wait_queue_t wait;
-+
-+                               init_waitqueue_entry(&wait, current);
-+                               add_wait_queue(&msblk->fragment_wait_queue,
-+                                                                       &wait);
-+                               set_current_state(TASK_UNINTERRUPTIBLE);
-+                               up(&msblk->fragment_mutex);
-+                               schedule();
-+                               set_current_state(TASK_RUNNING);
-+                               remove_wait_queue(&msblk->fragment_wait_queue,
-+                                                                       &wait);
-+                               continue;
-+                       }
-+                       msblk->next_fragment = nf;
-+                       
-+                       if (msblk->fragment[i].data == NULL)
-+                               if (!(msblk->fragment[i].data = SQUASHFS_ALLOC
-+                                               (SQUASHFS_FILE_MAX_SIZE))) {
-+                                       ERROR("Failed to allocate fragment "
-+                                                       "cache block\n");
-+                                       up(&msblk->fragment_mutex);
-+                                       goto out;
-+                               }
-+
-+                       msblk->fragment[i].block = SQUASHFS_INVALID_BLK;
-+                       msblk->fragment[i].locked = 1;
-+                       up(&msblk->fragment_mutex);
-+
-+                       if (!(msblk->fragment[i].length = squashfs_read_data(s,
-+                                               msblk->fragment[i].data,
-+                                               start_block, length, NULL))) {
-+                               ERROR("Unable to read fragment cache block "
-+                                                       "[%llx]\n", start_block);
-+                               msblk->fragment[i].locked = 0;
-+                               goto out;
-+                       }
-+
-+                       msblk->fragment[i].block = start_block;
-+                       TRACE("New fragment %d, start block %lld, locked %d\n",
-+                                               i, msblk->fragment[i].block,
-+                                               msblk->fragment[i].locked);
-+                       break;
-+               }
-+
-+               msblk->fragment[i].locked++;
-+               up(&msblk->fragment_mutex);
-+               TRACE("Got fragment %d, start block %lld, locked %d\n", i,
-+                                               msblk->fragment[i].block,
-+                                               msblk->fragment[i].locked);
-+               break;
-+       }
-+
-+       return &msblk->fragment[i];
-+
-+out:
-+       return NULL;
-+}
-+
-+
-+static struct inode *squashfs_new_inode(struct super_block *s,
-+               struct squashfs_base_inode_header *inodeb)
-+{
-+       struct squashfs_sb_info *msblk = s->s_fs_info;
-+       struct inode *i = new_inode(s);
-+
-+       if (i) {
-+               i->i_ino = inodeb->inode_number;
-+               i->i_mtime.tv_sec = inodeb->mtime;
-+               i->i_atime.tv_sec = inodeb->mtime;
-+               i->i_ctime.tv_sec = inodeb->mtime;
-+               i->i_uid = msblk->uid[inodeb->uid];
-+               i->i_mode = inodeb->mode;
-+               i->i_size = 0;
-+               if (inodeb->guid == SQUASHFS_GUIDS)
-+                       i->i_gid = i->i_uid;
-+               else
-+                       i->i_gid = msblk->guid[inodeb->guid];
-+       }
-+
-+       return i;
-+}
-+
-+
-+static struct inode *squashfs_iget(struct super_block *s, squashfs_inode_t inode)
-+{
-+       struct inode *i;
-+       struct squashfs_sb_info *msblk = s->s_fs_info;
-+       struct squashfs_super_block *sblk = &msblk->sblk;
-+       long long block = SQUASHFS_INODE_BLK(inode) +
-+               sblk->inode_table_start;
-+       unsigned int offset = SQUASHFS_INODE_OFFSET(inode);
-+       long long next_block;
-+       unsigned int next_offset;
-+       union squashfs_inode_header id, sid;
-+       struct squashfs_base_inode_header *inodeb = &id.base,
-+                                         *sinodeb = &sid.base;
-+
-+       TRACE("Entered squashfs_iget\n");
-+
-+       if (msblk->swap) {
-+               if (!squashfs_get_cached_block(s, (char *) sinodeb, block,
-+                                       offset, sizeof(*sinodeb), &next_block,
-+                                       &next_offset))
-+                       goto failed_read;
-+               SQUASHFS_SWAP_BASE_INODE_HEADER(inodeb, sinodeb,
-+                                       sizeof(*sinodeb));
-+       } else
-+               if (!squashfs_get_cached_block(s, (char *) inodeb, block,
-+                                       offset, sizeof(*inodeb), &next_block,
-+                                       &next_offset))
-+                       goto failed_read;
-+
-+       switch(inodeb->inode_type) {
-+               case SQUASHFS_FILE_TYPE: {
-+                       unsigned int frag_size;
-+                       long long frag_blk;
-+                       struct squashfs_reg_inode_header *inodep = &id.reg;
-+                       struct squashfs_reg_inode_header *sinodep = &sid.reg;
-+                               
-+                       if (msblk->swap) {
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               sinodep, block, offset,
-+                                               sizeof(*sinodep), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+                               SQUASHFS_SWAP_REG_INODE_HEADER(inodep, sinodep);
-+                       } else
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               inodep, block, offset,
-+                                               sizeof(*inodep), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+
-+                       frag_blk = SQUASHFS_INVALID_BLK;
-+                       if (inodep->fragment != SQUASHFS_INVALID_FRAG &&
-+                                       !get_fragment_location(s,
-+                                       inodep->fragment, &frag_blk, &frag_size))
-+                               goto failed_read;
-+                               
-+                       if((i = squashfs_new_inode(s, inodeb)) == NULL)
-+                               goto failed_read1;
-+
-+                       i->i_nlink = 1;
-+                       i->i_size = inodep->file_size;
-+                       i->i_fop = &generic_ro_fops;
-+                       i->i_mode |= S_IFREG;
-+                       i->i_blocks = ((i->i_size - 1) >> 9) + 1;
-+                       SQUASHFS_I(i)->u.s1.fragment_start_block = frag_blk;
-+                       SQUASHFS_I(i)->u.s1.fragment_size = frag_size;
-+                       SQUASHFS_I(i)->u.s1.fragment_offset = inodep->offset;
-+                       SQUASHFS_I(i)->start_block = inodep->start_block;
-+                       SQUASHFS_I(i)->u.s1.block_list_start = next_block;
-+                       SQUASHFS_I(i)->offset = next_offset;
-+                       if (sblk->block_size > 4096)
-+                               i->i_data.a_ops = &squashfs_aops;
-+                       else
-+                               i->i_data.a_ops = &squashfs_aops_4K;
-+
-+                       TRACE("File inode %x:%x, start_block %llx, "
-+                                       "block_list_start %llx, offset %x\n",
-+                                       SQUASHFS_INODE_BLK(inode), offset,
-+                                       inodep->start_block, next_block,
-+                                       next_offset);
-+                       break;
-+               }
-+               case SQUASHFS_LREG_TYPE: {
-+                       unsigned int frag_size;
-+                       long long frag_blk;
-+                       struct squashfs_lreg_inode_header *inodep = &id.lreg;
-+                       struct squashfs_lreg_inode_header *sinodep = &sid.lreg;
-+                               
-+                       if (msblk->swap) {
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               sinodep, block, offset,
-+                                               sizeof(*sinodep), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+                               SQUASHFS_SWAP_LREG_INODE_HEADER(inodep, sinodep);
-+                       } else
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               inodep, block, offset,
-+                                               sizeof(*inodep), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+
-+                       frag_blk = SQUASHFS_INVALID_BLK;
-+                       if (inodep->fragment != SQUASHFS_INVALID_FRAG &&
-+                                       !get_fragment_location(s,
-+                                       inodep->fragment, &frag_blk, &frag_size))
-+                               goto failed_read;
-+                               
-+                       if((i = squashfs_new_inode(s, inodeb)) == NULL)
-+                               goto failed_read1;
-+
-+                       i->i_nlink = inodep->nlink;
-+                       i->i_size = inodep->file_size;
-+                       i->i_fop = &generic_ro_fops;
-+                       i->i_mode |= S_IFREG;
-+                       i->i_blocks = ((i->i_size - 1) >> 9) + 1;
-+                       SQUASHFS_I(i)->u.s1.fragment_start_block = frag_blk;
-+                       SQUASHFS_I(i)->u.s1.fragment_size = frag_size;
-+                       SQUASHFS_I(i)->u.s1.fragment_offset = inodep->offset;
-+                       SQUASHFS_I(i)->start_block = inodep->start_block;
-+                       SQUASHFS_I(i)->u.s1.block_list_start = next_block;
-+                       SQUASHFS_I(i)->offset = next_offset;
-+                       if (sblk->block_size > 4096)
-+                               i->i_data.a_ops = &squashfs_aops;
-+                       else
-+                               i->i_data.a_ops = &squashfs_aops_4K;
-+
-+                       TRACE("File inode %x:%x, start_block %llx, "
-+                                       "block_list_start %llx, offset %x\n",
-+                                       SQUASHFS_INODE_BLK(inode), offset,
-+                                       inodep->start_block, next_block,
-+                                       next_offset);
-+                       break;
-+               }
-+               case SQUASHFS_DIR_TYPE: {
-+                       struct squashfs_dir_inode_header *inodep = &id.dir;
-+                       struct squashfs_dir_inode_header *sinodep = &sid.dir;
-+
-+                       if (msblk->swap) {
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               sinodep, block, offset,
-+                                               sizeof(*sinodep), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+                               SQUASHFS_SWAP_DIR_INODE_HEADER(inodep, sinodep);
-+                       } else
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               inodep, block, offset,
-+                                               sizeof(*inodep), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+
-+                       if((i = squashfs_new_inode(s, inodeb)) == NULL)
-+                               goto failed_read1;
-+
-+                       i->i_nlink = inodep->nlink;
-+                       i->i_size = inodep->file_size;
-+                       i->i_op = &squashfs_dir_inode_ops;
-+                       i->i_fop = &squashfs_dir_ops;
-+                       i->i_mode |= S_IFDIR;
-+                       SQUASHFS_I(i)->start_block = inodep->start_block;
-+                       SQUASHFS_I(i)->offset = inodep->offset;
-+                       SQUASHFS_I(i)->u.s2.directory_index_count = 0;
-+                       SQUASHFS_I(i)->u.s2.parent_inode = inodep->parent_inode;
-+
-+                       TRACE("Directory inode %x:%x, start_block %x, offset "
-+                                       "%x\n", SQUASHFS_INODE_BLK(inode),
-+                                       offset, inodep->start_block,
-+                                       inodep->offset);
-+                       break;
-+               }
-+               case SQUASHFS_LDIR_TYPE: {
-+                       struct squashfs_ldir_inode_header *inodep = &id.ldir;
-+                       struct squashfs_ldir_inode_header *sinodep = &sid.ldir;
-+
-+                       if (msblk->swap) {
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               sinodep, block, offset,
-+                                               sizeof(*sinodep), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+                               SQUASHFS_SWAP_LDIR_INODE_HEADER(inodep,
-+                                               sinodep);
-+                       } else
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               inodep, block, offset,
-+                                               sizeof(*inodep), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+
-+                       if((i = squashfs_new_inode(s, inodeb)) == NULL)
-+                               goto failed_read1;
-+
-+                       i->i_nlink = inodep->nlink;
-+                       i->i_size = inodep->file_size;
-+                       i->i_op = &squashfs_dir_inode_ops;
-+                       i->i_fop = &squashfs_dir_ops;
-+                       i->i_mode |= S_IFDIR;
-+                       SQUASHFS_I(i)->start_block = inodep->start_block;
-+                       SQUASHFS_I(i)->offset = inodep->offset;
-+                       SQUASHFS_I(i)->u.s2.directory_index_start = next_block;
-+                       SQUASHFS_I(i)->u.s2.directory_index_offset =
-+                                                               next_offset;
-+                       SQUASHFS_I(i)->u.s2.directory_index_count =
-+                                                               inodep->i_count;
-+                       SQUASHFS_I(i)->u.s2.parent_inode = inodep->parent_inode;
-+
-+                       TRACE("Long directory inode %x:%x, start_block %x, "
-+                                       "offset %x\n",
-+                                       SQUASHFS_INODE_BLK(inode), offset,
-+                                       inodep->start_block, inodep->offset);
-+                       break;
-+               }
-+               case SQUASHFS_SYMLINK_TYPE: {
-+                       struct squashfs_symlink_inode_header *inodep =
-+                                                               &id.symlink;
-+                       struct squashfs_symlink_inode_header *sinodep =
-+                                                               &sid.symlink;
-+       
-+                       if (msblk->swap) {
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               sinodep, block, offset,
-+                                               sizeof(*sinodep), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+                               SQUASHFS_SWAP_SYMLINK_INODE_HEADER(inodep,
-+                                                               sinodep);
-+                       } else
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               inodep, block, offset,
-+                                               sizeof(*inodep), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+
-+                       if((i = squashfs_new_inode(s, inodeb)) == NULL)
-+                               goto failed_read1;
-+
-+                       i->i_nlink = inodep->nlink;
-+                       i->i_size = inodep->symlink_size;
-+                       i->i_op = &page_symlink_inode_operations;
-+                       i->i_data.a_ops = &squashfs_symlink_aops;
-+                       i->i_mode |= S_IFLNK;
-+                       SQUASHFS_I(i)->start_block = next_block;
-+                       SQUASHFS_I(i)->offset = next_offset;
-+
-+                       TRACE("Symbolic link inode %x:%x, start_block %llx, "
-+                                       "offset %x\n",
-+                                       SQUASHFS_INODE_BLK(inode), offset,
-+                                       next_block, next_offset);
-+                       break;
-+                }
-+                case SQUASHFS_BLKDEV_TYPE:
-+                case SQUASHFS_CHRDEV_TYPE: {
-+                       struct squashfs_dev_inode_header *inodep = &id.dev;
-+                       struct squashfs_dev_inode_header *sinodep = &sid.dev;
-+
-+                       if (msblk->swap) {
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               sinodep, block, offset,
-+                                               sizeof(*sinodep), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+                               SQUASHFS_SWAP_DEV_INODE_HEADER(inodep, sinodep);
-+                       } else  
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               inodep, block, offset,
-+                                               sizeof(*inodep), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+
-+                       if ((i = squashfs_new_inode(s, inodeb)) == NULL)
-+                               goto failed_read1;
-+
-+                       i->i_nlink = inodep->nlink;
-+                       i->i_mode |= (inodeb->inode_type ==
-+                                       SQUASHFS_CHRDEV_TYPE) ?  S_IFCHR :
-+                                       S_IFBLK;
-+                       init_special_inode(i, i->i_mode,
-+                                       old_decode_dev(inodep->rdev));
-+
-+                       TRACE("Device inode %x:%x, rdev %x\n",
-+                                       SQUASHFS_INODE_BLK(inode), offset,
-+                                       inodep->rdev);
-+                       break;
-+                }
-+                case SQUASHFS_FIFO_TYPE:
-+                case SQUASHFS_SOCKET_TYPE: {
-+                       struct squashfs_ipc_inode_header *inodep = &id.ipc;
-+                       struct squashfs_ipc_inode_header *sinodep = &sid.ipc;
-+
-+                       if (msblk->swap) {
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               sinodep, block, offset,
-+                                               sizeof(*sinodep), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+                               SQUASHFS_SWAP_IPC_INODE_HEADER(inodep, sinodep);
-+                       } else  
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               inodep, block, offset,
-+                                               sizeof(*inodep), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+
-+                       if ((i = squashfs_new_inode(s, inodeb)) == NULL)
-+                               goto failed_read1;
-+
-+                       i->i_nlink = inodep->nlink;
-+                       i->i_mode |= (inodeb->inode_type == SQUASHFS_FIFO_TYPE)
-+                                                       ? S_IFIFO : S_IFSOCK;
-+                       init_special_inode(i, i->i_mode, 0);
-+                       break;
-+                }
-+                default:
-+                       ERROR("Unknown inode type %d in squashfs_iget!\n",
-+                                       inodeb->inode_type);
-+                       goto failed_read1;
-+       }
-+       
-+       insert_inode_hash(i);
-+       return i;
-+
-+failed_read:
-+       ERROR("Unable to read inode [%llx:%x]\n", block, offset);
-+
-+failed_read1:
-+       return NULL;
-+}
-+
-+
-+static int read_fragment_index_table(struct super_block *s)
-+{
-+       struct squashfs_sb_info *msblk = s->s_fs_info;
-+       struct squashfs_super_block *sblk = &msblk->sblk;
-+
-+       /* Allocate fragment index table */
-+       if (!(msblk->fragment_index = kmalloc(SQUASHFS_FRAGMENT_INDEX_BYTES
-+                                       (sblk->fragments), GFP_KERNEL))) {
-+               ERROR("Failed to allocate uid/gid table\n");
-+               return 0;
-+       }
-+   
-+       if (SQUASHFS_FRAGMENT_INDEX_BYTES(sblk->fragments) &&
-+                                       !squashfs_read_data(s, (char *)
-+                                       msblk->fragment_index,
-+                                       sblk->fragment_table_start,
-+                                       SQUASHFS_FRAGMENT_INDEX_BYTES
-+                                       (sblk->fragments) |
-+                                       SQUASHFS_COMPRESSED_BIT_BLOCK, NULL)) {
-+               ERROR("unable to read fragment index table\n");
-+               return 0;
-+       }
-+
-+       if (msblk->swap) {
-+               int i;
-+               long long fragment;
-+
-+               for (i = 0; i < SQUASHFS_FRAGMENT_INDEXES(sblk->fragments);
-+                                                                       i++) {
-+                       SQUASHFS_SWAP_FRAGMENT_INDEXES((&fragment),
-+                                               &msblk->fragment_index[i], 1);
-+                       msblk->fragment_index[i] = fragment;
-+               }
-+       }
-+
-+       return 1;
-+}
-+
-+
-+static int supported_squashfs_filesystem(struct squashfs_sb_info *msblk, int silent)
-+{
-+       struct squashfs_super_block *sblk = &msblk->sblk;
-+
-+       msblk->iget = squashfs_iget;
-+       msblk->read_blocklist = read_blocklist;
-+       msblk->read_fragment_index_table = read_fragment_index_table;
-+
-+       if (sblk->s_major == 1) {
-+               if (!squashfs_1_0_supported(msblk)) {
-+                       SERROR("Major/Minor mismatch, Squashfs 1.0 filesystems "
-+                               "are unsupported\n");
-+                       SERROR("Please recompile with "
-+                               "Squashfs 1.0 support enabled\n");
-+                       return 0;
-+               }
-+       } else if (sblk->s_major == 2) {
-+               if (!squashfs_2_0_supported(msblk)) {
-+                       SERROR("Major/Minor mismatch, Squashfs 2.0 filesystems "
-+                               "are unsupported\n");
-+                       SERROR("Please recompile with "
-+                               "Squashfs 2.0 support enabled\n");
-+                       return 0;
-+               }
-+       } else if(sblk->s_major != SQUASHFS_MAJOR || sblk->s_minor >
-+                       SQUASHFS_MINOR) {
-+               SERROR("Major/Minor mismatch, trying to mount newer %d.%d "
-+                               "filesystem\n", sblk->s_major, sblk->s_minor);
-+               SERROR("Please update your kernel\n");
-+               return 0;
-+       }
-+
-+       return 1;
-+}
-+
-+
-+static int squashfs_fill_super(struct super_block *s, void *data, int silent)
-+{
-+       struct squashfs_sb_info *msblk;
-+       struct squashfs_super_block *sblk;
-+       int i;
-+       char b[BDEVNAME_SIZE];
-+       struct inode *root;
-+
-+       TRACE("Entered squashfs_read_superblock\n");
-+
-+       if (!(s->s_fs_info = kmalloc(sizeof(struct squashfs_sb_info),
-+                                               GFP_KERNEL))) {
-+               ERROR("Failed to allocate superblock\n");
-+               goto failure;
-+       }
-+       memset(s->s_fs_info, 0, sizeof(struct squashfs_sb_info));
-+       msblk = s->s_fs_info;
-+       sblk = &msblk->sblk;
-+       
-+       msblk->devblksize = sb_min_blocksize(s, BLOCK_SIZE);
-+       msblk->devblksize_log2 = ffz(~msblk->devblksize);
-+
-+       init_MUTEX(&msblk->read_data_mutex);
-+       init_MUTEX(&msblk->read_page_mutex);
-+       init_MUTEX(&msblk->block_cache_mutex);
-+       init_MUTEX(&msblk->fragment_mutex);
-+       init_MUTEX(&msblk->meta_index_mutex);
-+       
-+       init_waitqueue_head(&msblk->waitq);
-+       init_waitqueue_head(&msblk->fragment_wait_queue);
-+
-+       if (!squashfs_read_data(s, (char *) sblk, SQUASHFS_START,
-+                                       sizeof(struct squashfs_super_block) |
-+                                       SQUASHFS_COMPRESSED_BIT_BLOCK, NULL)) {
-+               SERROR("unable to read superblock\n");
-+               goto failed_mount;
-+       }
-+
-+       /* Check it is a SQUASHFS superblock */
-+       msblk->swap = 0;
-+       if ((s->s_magic = sblk->s_magic) != SQUASHFS_MAGIC) {
-+               if (sblk->s_magic == SQUASHFS_MAGIC_SWAP) {
-+                       struct squashfs_super_block ssblk;
-+
-+                       WARNING("Mounting a different endian SQUASHFS "
-+                               "filesystem on %s\n", bdevname(s->s_bdev, b));
-+
-+                       SQUASHFS_SWAP_SUPER_BLOCK(&ssblk, sblk);
-+                       memcpy(sblk, &ssblk, sizeof(struct squashfs_super_block));
-+                       msblk->swap = 1;
-+               } else  {
-+                       SERROR("Can't find a SQUASHFS superblock on %s\n",
-+                                                       bdevname(s->s_bdev, b));
-+                       goto failed_mount;
-+               }
-+       }
-+
-+       /* Check the MAJOR & MINOR versions */
-+       if(!supported_squashfs_filesystem(msblk, silent))
-+               goto failed_mount;
-+
-+       TRACE("Found valid superblock on %s\n", bdevname(s->s_bdev, b));
-+       TRACE("Inodes are %scompressed\n",
-+                                       SQUASHFS_UNCOMPRESSED_INODES
-+                                       (sblk->flags) ? "un" : "");
-+       TRACE("Data is %scompressed\n",
-+                                       SQUASHFS_UNCOMPRESSED_DATA(sblk->flags)
-+                                       ? "un" : "");
-+       TRACE("Check data is %s present in the filesystem\n",
-+                                       SQUASHFS_CHECK_DATA(sblk->flags) ?
-+                                       "" : "not");
-+       TRACE("Filesystem size %lld bytes\n", sblk->bytes_used);
-+       TRACE("Block size %d\n", sblk->block_size);
-+       TRACE("Number of inodes %d\n", sblk->inodes);
-+       if (sblk->s_major > 1)
-+               TRACE("Number of fragments %d\n", sblk->fragments);
-+       TRACE("Number of uids %d\n", sblk->no_uids);
-+       TRACE("Number of gids %d\n", sblk->no_guids);
-+       TRACE("sblk->inode_table_start %llx\n", sblk->inode_table_start);
-+       TRACE("sblk->directory_table_start %llx\n", sblk->directory_table_start);
-+       if (sblk->s_major > 1)
-+               TRACE("sblk->fragment_table_start %llx\n",
-+                                       sblk->fragment_table_start);
-+       TRACE("sblk->uid_start %llx\n", sblk->uid_start);
-+
-+       s->s_flags |= MS_RDONLY;
-+       s->s_op = &squashfs_ops;
-+
-+       /* Init inode_table block pointer array */
-+       if (!(msblk->block_cache = kmalloc(sizeof(struct squashfs_cache) *
-+                                       SQUASHFS_CACHED_BLKS, GFP_KERNEL))) {
-+               ERROR("Failed to allocate block cache\n");
-+               goto failed_mount;
-+       }
-+
-+       for (i = 0; i < SQUASHFS_CACHED_BLKS; i++)
-+               msblk->block_cache[i].block = SQUASHFS_INVALID_BLK;
-+
-+       msblk->next_cache = 0;
-+
-+       /* Allocate read_data block */
-+       msblk->read_size = (sblk->block_size < SQUASHFS_METADATA_SIZE) ?
-+                                       SQUASHFS_METADATA_SIZE :
-+                                       sblk->block_size;
-+
-+       if (!(msblk->read_data = kmalloc(msblk->read_size, GFP_KERNEL))) {
-+               ERROR("Failed to allocate read_data block\n");
-+               goto failed_mount;
-+       }
-+
-+       /* Allocate read_page block */
-+       if (!(msblk->read_page = kmalloc(sblk->block_size, GFP_KERNEL))) {
-+               ERROR("Failed to allocate read_page block\n");
-+               goto failed_mount;
-+       }
-+
-+       /* Allocate uid and gid tables */
-+       if (!(msblk->uid = kmalloc((sblk->no_uids + sblk->no_guids) *
-+                                       sizeof(unsigned int), GFP_KERNEL))) {
-+               ERROR("Failed to allocate uid/gid table\n");
-+               goto failed_mount;
-+       }
-+       msblk->guid = msblk->uid + sblk->no_uids;
-+   
-+       if (msblk->swap) {
-+               unsigned int suid[sblk->no_uids + sblk->no_guids];
-+
-+               if (!squashfs_read_data(s, (char *) &suid, sblk->uid_start,
-+                                       ((sblk->no_uids + sblk->no_guids) *
-+                                        sizeof(unsigned int)) |
-+                                       SQUASHFS_COMPRESSED_BIT_BLOCK, NULL)) {
-+                       ERROR("unable to read uid/gid table\n");
-+                       goto failed_mount;
-+               }
-+
-+               SQUASHFS_SWAP_DATA(msblk->uid, suid, (sblk->no_uids +
-+                       sblk->no_guids), (sizeof(unsigned int) * 8));
-+       } else
-+               if (!squashfs_read_data(s, (char *) msblk->uid, sblk->uid_start,
-+                                       ((sblk->no_uids + sblk->no_guids) *
-+                                        sizeof(unsigned int)) |
-+                                       SQUASHFS_COMPRESSED_BIT_BLOCK, NULL)) {
-+                       ERROR("unable to read uid/gid table\n");
-+                       goto failed_mount;
-+               }
-+
-+
-+       if (sblk->s_major == 1 && squashfs_1_0_supported(msblk))
-+               goto allocate_root;
-+
-+       if (!(msblk->fragment = kmalloc(sizeof(struct squashfs_fragment_cache) *
-+                               SQUASHFS_CACHED_FRAGMENTS, GFP_KERNEL))) {
-+               ERROR("Failed to allocate fragment block cache\n");
-+               goto failed_mount;
-+       }
-+
-+       for (i = 0; i < SQUASHFS_CACHED_FRAGMENTS; i++) {
-+               msblk->fragment[i].locked = 0;
-+               msblk->fragment[i].block = SQUASHFS_INVALID_BLK;
-+               msblk->fragment[i].data = NULL;
-+       }
-+
-+       msblk->next_fragment = 0;
-+
-+       /* Allocate fragment index table */
-+       if (msblk->read_fragment_index_table(s) == 0)
-+               goto failed_mount;
-+
-+allocate_root:
-+       if ((root = (msblk->iget)(s, sblk->root_inode)) == NULL)
-+               goto failed_mount;
-+
-+       if ((s->s_root = d_alloc_root(root)) == NULL) {
-+               ERROR("Root inode create failed\n");
-+               iput(root);
-+               goto failed_mount;
-+       }
-+
-+       TRACE("Leaving squashfs_read_super\n");
-+       return 0;
-+
-+failed_mount:
-+       kfree(msblk->fragment_index);
-+       kfree(msblk->fragment);
-+       kfree(msblk->uid);
-+       kfree(msblk->read_page);
-+       kfree(msblk->read_data);
-+       kfree(msblk->block_cache);
-+       kfree(msblk->fragment_index_2);
-+       kfree(s->s_fs_info);
-+       s->s_fs_info = NULL;
-+       return -EINVAL;
-+
-+failure:
-+       return -ENOMEM;
-+}
-+
-+
-+static int squashfs_statfs(struct dentry *dentry, struct kstatfs *buf)
-+{
-+       struct super_block *s = dentry->d_sb;
-+       struct squashfs_sb_info *msblk = s->s_fs_info;
-+       struct squashfs_super_block *sblk = &msblk->sblk;
-+
-+       TRACE("Entered squashfs_statfs\n");
-+
-+       buf->f_type = SQUASHFS_MAGIC;
-+       buf->f_bsize = sblk->block_size;
-+       buf->f_blocks = ((sblk->bytes_used - 1) >> sblk->block_log) + 1;
-+       buf->f_bfree = buf->f_bavail = 0;
-+       buf->f_files = sblk->inodes;
-+       buf->f_ffree = 0;
-+       buf->f_namelen = SQUASHFS_NAME_LEN;
-+
-+       return 0;
-+}
-+
-+
-+static int squashfs_symlink_readpage(struct file *file, struct page *page)
-+{
-+       struct inode *inode = page->mapping->host;
-+       int index = page->index << PAGE_CACHE_SHIFT, length, bytes;
-+       long long block = SQUASHFS_I(inode)->start_block;
-+       int offset = SQUASHFS_I(inode)->offset;
-+       void *pageaddr = kmap(page);
-+
-+       TRACE("Entered squashfs_symlink_readpage, page index %ld, start block "
-+                               "%llx, offset %x\n", page->index,
-+                               SQUASHFS_I(inode)->start_block,
-+                               SQUASHFS_I(inode)->offset);
-+
-+       for (length = 0; length < index; length += bytes) {
-+               if (!(bytes = squashfs_get_cached_block(inode->i_sb, NULL,
-+                               block, offset, PAGE_CACHE_SIZE, &block,
-+                               &offset))) {
-+                       ERROR("Unable to read symbolic link [%llx:%x]\n", block,
-+                                       offset);
-+                       goto skip_read;
-+               }
-+       }
-+
-+       if (length != index) {
-+               ERROR("(squashfs_symlink_readpage) length != index\n");
-+               bytes = 0;
-+               goto skip_read;
-+       }
-+
-+       bytes = (i_size_read(inode) - length) > PAGE_CACHE_SIZE ? PAGE_CACHE_SIZE :
-+                                       i_size_read(inode) - length;
-+
-+       if (!(bytes = squashfs_get_cached_block(inode->i_sb, pageaddr, block,
-+                                       offset, bytes, &block, &offset)))
-+               ERROR("Unable to read symbolic link [%llx:%x]\n", block, offset);
-+
-+skip_read:
-+       memset(pageaddr + bytes, 0, PAGE_CACHE_SIZE - bytes);
-+       kunmap(page);
-+       SetPageUptodate(page);
-+       unlock_page(page);
-+
-+       return 0;
-+}
-+
-+
-+struct meta_index *locate_meta_index(struct inode *inode, int index, int offset)
-+{
-+       struct meta_index *meta = NULL;
-+       struct squashfs_sb_info *msblk = inode->i_sb->s_fs_info;
-+       int i;
-+
-+       down(&msblk->meta_index_mutex);
-+
-+       TRACE("locate_meta_index: index %d, offset %d\n", index, offset);
-+
-+       if(msblk->meta_index == NULL)
-+               goto not_allocated;
-+
-+       for (i = 0; i < SQUASHFS_META_NUMBER; i ++)
-+               if (msblk->meta_index[i].inode_number == inode->i_ino &&
-+                               msblk->meta_index[i].offset >= offset &&
-+                               msblk->meta_index[i].offset <= index &&
-+                               msblk->meta_index[i].locked == 0) {
-+                       TRACE("locate_meta_index: entry %d, offset %d\n", i,
-+                                       msblk->meta_index[i].offset);
-+                       meta = &msblk->meta_index[i];
-+                       offset = meta->offset;
-+               }
-+
-+       if (meta)
-+               meta->locked = 1;
-+
-+not_allocated:
-+       up(&msblk->meta_index_mutex);
-+
-+       return meta;
-+}
-+
-+
-+struct meta_index *empty_meta_index(struct inode *inode, int offset, int skip)
-+{
-+       struct squashfs_sb_info *msblk = inode->i_sb->s_fs_info;
-+       struct meta_index *meta = NULL;
-+       int i;
-+
-+       down(&msblk->meta_index_mutex);
-+
-+       TRACE("empty_meta_index: offset %d, skip %d\n", offset, skip);
-+
-+       if(msblk->meta_index == NULL) {
-+               if (!(msblk->meta_index = kmalloc(sizeof(struct meta_index) *
-+                                       SQUASHFS_META_NUMBER, GFP_KERNEL))) {
-+                       ERROR("Failed to allocate meta_index\n");
-+                       goto failed;
-+               }
-+               for(i = 0; i < SQUASHFS_META_NUMBER; i++) {
-+                       msblk->meta_index[i].inode_number = 0;
-+                       msblk->meta_index[i].locked = 0;
-+               }
-+               msblk->next_meta_index = 0;
-+       }
-+
-+       for(i = SQUASHFS_META_NUMBER; i &&
-+                       msblk->meta_index[msblk->next_meta_index].locked; i --)
-+               msblk->next_meta_index = (msblk->next_meta_index + 1) %
-+                       SQUASHFS_META_NUMBER;
-+
-+       if(i == 0) {
-+               TRACE("empty_meta_index: failed!\n");
-+               goto failed;
-+       }
-+
-+       TRACE("empty_meta_index: returned meta entry %d, %p\n",
-+                       msblk->next_meta_index,
-+                       &msblk->meta_index[msblk->next_meta_index]);
-+
-+       meta = &msblk->meta_index[msblk->next_meta_index];
-+       msblk->next_meta_index = (msblk->next_meta_index + 1) %
-+                       SQUASHFS_META_NUMBER;
-+
-+       meta->inode_number = inode->i_ino;
-+       meta->offset = offset;
-+       meta->skip = skip;
-+       meta->entries = 0;
-+       meta->locked = 1;
-+
-+failed:
-+       up(&msblk->meta_index_mutex);
-+       return meta;
-+}
-+
-+
-+void release_meta_index(struct inode *inode, struct meta_index *meta)
-+{
-+       meta->locked = 0;
-+}
-+
-+
-+static int read_block_index(struct super_block *s, int blocks, char *block_list,
-+               long long *start_block, int *offset)
-+{
-+       struct squashfs_sb_info *msblk = s->s_fs_info;
-+       unsigned int *block_listp;
-+       int block = 0;
-+       
-+       if (msblk->swap) {
-+               char sblock_list[blocks << 2];
-+
-+               if (!squashfs_get_cached_block(s, sblock_list, *start_block,
-+                               *offset, blocks << 2, start_block, offset)) {
-+                       ERROR("Unable to read block list [%llx:%x]\n",
-+                               *start_block, *offset);
-+                       goto failure;
-+               }
-+               SQUASHFS_SWAP_INTS(((unsigned int *)block_list),
-+                               ((unsigned int *)sblock_list), blocks);
-+       } else
-+               if (!squashfs_get_cached_block(s, block_list, *start_block,
-+                               *offset, blocks << 2, start_block, offset)) {
-+                       ERROR("Unable to read block list [%llx:%x]\n",
-+                               *start_block, *offset);
-+                       goto failure;
-+               }
-+
-+       for (block_listp = (unsigned int *) block_list; blocks;
-+                               block_listp++, blocks --)
-+               block += SQUASHFS_COMPRESSED_SIZE_BLOCK(*block_listp);
-+
-+       return block;
-+
-+failure:
-+       return -1;
-+}
-+
-+
-+#define SIZE 256
-+
-+static inline int calculate_skip(int blocks) {
-+       int skip = (blocks - 1) / ((SQUASHFS_SLOTS * SQUASHFS_META_ENTRIES + 1) * SQUASHFS_META_INDEXES);
-+       return skip >= 7 ? 7 : skip + 1;
-+}
-+
-+
-+static int get_meta_index(struct inode *inode, int index,
-+               long long *index_block, int *index_offset,
-+               long long *data_block, char *block_list)
-+{
-+       struct squashfs_sb_info *msblk = inode->i_sb->s_fs_info;
-+       struct squashfs_super_block *sblk = &msblk->sblk;
-+       int skip = calculate_skip(i_size_read(inode) >> sblk->block_log);
-+       int offset = 0;
-+       struct meta_index *meta;
-+       struct meta_entry *meta_entry;
-+       long long cur_index_block = SQUASHFS_I(inode)->u.s1.block_list_start;
-+       int cur_offset = SQUASHFS_I(inode)->offset;
-+       long long cur_data_block = SQUASHFS_I(inode)->start_block;
-+       int i;
-+ 
-+       index /= SQUASHFS_META_INDEXES * skip;
-+
-+       while ( offset < index ) {
-+               meta = locate_meta_index(inode, index, offset + 1);
-+
-+               if (meta == NULL) {
-+                       if ((meta = empty_meta_index(inode, offset + 1,
-+                                                       skip)) == NULL)
-+                               goto all_done;
-+               } else {
-+                       offset = index < meta->offset + meta->entries ? index :
-+                               meta->offset + meta->entries - 1;
-+                       meta_entry = &meta->meta_entry[offset - meta->offset];
-+                       cur_index_block = meta_entry->index_block + sblk->inode_table_start;
-+                       cur_offset = meta_entry->offset;
-+                       cur_data_block = meta_entry->data_block;
-+                       TRACE("get_meta_index: offset %d, meta->offset %d, "
-+                               "meta->entries %d\n", offset, meta->offset,
-+                               meta->entries);
-+                       TRACE("get_meta_index: index_block 0x%llx, offset 0x%x"
-+                               " data_block 0x%llx\n", cur_index_block,
-+                               cur_offset, cur_data_block);
-+               }
-+
-+               for (i = meta->offset + meta->entries; i <= index &&
-+                               i < meta->offset + SQUASHFS_META_ENTRIES; i++) {
-+                       int blocks = skip * SQUASHFS_META_INDEXES;
-+
-+                       while (blocks) {
-+                               int block = blocks > (SIZE >> 2) ? (SIZE >> 2) :
-+                                       blocks;
-+                               int res = read_block_index(inode->i_sb, block,
-+                                       block_list, &cur_index_block,
-+                                       &cur_offset);
-+
-+                               if (res == -1)
-+                                       goto failed;
-+
-+                               cur_data_block += res;
-+                               blocks -= block;
-+                       }
-+
-+                       meta_entry = &meta->meta_entry[i - meta->offset];
-+                       meta_entry->index_block = cur_index_block - sblk->inode_table_start;
-+                       meta_entry->offset = cur_offset;
-+                       meta_entry->data_block = cur_data_block;
-+                       meta->entries ++;
-+                       offset ++;
-+               }
-+
-+               TRACE("get_meta_index: meta->offset %d, meta->entries %d\n",
-+                               meta->offset, meta->entries);
-+
-+               release_meta_index(inode, meta);
-+       }
-+
-+all_done:
-+       *index_block = cur_index_block;
-+       *index_offset = cur_offset;
-+       *data_block = cur_data_block;
-+
-+       return offset * SQUASHFS_META_INDEXES * skip;
-+
-+failed:
-+       release_meta_index(inode, meta);
-+       return -1;
-+}
-+
-+
-+static long long read_blocklist(struct inode *inode, int index,
-+                               int readahead_blks, char *block_list,
-+                               unsigned short **block_p, unsigned int *bsize)
-+{
-+       long long block_ptr;
-+       int offset;
-+       long long block;
-+       int res = get_meta_index(inode, index, &block_ptr, &offset, &block,
-+               block_list);
-+
-+       TRACE("read_blocklist: res %d, index %d, block_ptr 0x%llx, offset"
-+                      " 0x%x, block 0x%llx\n", res, index, block_ptr, offset,
-+                      block);
-+
-+       if(res == -1)
-+               goto failure;
-+
-+       index -= res;
-+
-+       while ( index ) {
-+               int blocks = index > (SIZE >> 2) ? (SIZE >> 2) : index;
-+               int res = read_block_index(inode->i_sb, blocks, block_list,
-+                       &block_ptr, &offset);
-+               if (res == -1)
-+                       goto failure;
-+               block += res;
-+               index -= blocks;
-+       }
-+
-+       if (read_block_index(inode->i_sb, 1, block_list,
-+                       &block_ptr, &offset) == -1)
-+               goto failure;
-+       *bsize = *((unsigned int *) block_list);
-+
-+       return block;
-+
-+failure:
-+       return 0;
-+}
-+
-+
-+static int squashfs_readpage(struct file *file, struct page *page)
-+{
-+       struct inode *inode = page->mapping->host;
-+       struct squashfs_sb_info *msblk = inode->i_sb->s_fs_info;
-+       struct squashfs_super_block *sblk = &msblk->sblk;
-+       unsigned char block_list[SIZE];
-+       long long block;
-+       unsigned int bsize, i = 0, bytes = 0, byte_offset = 0;
-+       int index = page->index >> (sblk->block_log - PAGE_CACHE_SHIFT);
-+       void *pageaddr;
-+       struct squashfs_fragment_cache *fragment = NULL;
-+       char *data_ptr = msblk->read_page;
-+       
-+       int mask = (1 << (sblk->block_log - PAGE_CACHE_SHIFT)) - 1;
-+       int start_index = page->index & ~mask;
-+       int end_index = start_index | mask;
-+
-+       TRACE("Entered squashfs_readpage, page index %lx, start block %llx\n",
-+                                       page->index,
-+                                       SQUASHFS_I(inode)->start_block);
-+
-+       if (page->index >= ((i_size_read(inode) + PAGE_CACHE_SIZE - 1) >>
-+                                       PAGE_CACHE_SHIFT))
-+               goto skip_read;
-+
-+       if (SQUASHFS_I(inode)->u.s1.fragment_start_block == SQUASHFS_INVALID_BLK
-+                                       || index < (i_size_read(inode) >>
-+                                       sblk->block_log)) {
-+               if ((block = (msblk->read_blocklist)(inode, index, 1,
-+                                       block_list, NULL, &bsize)) == 0)
-+                       goto skip_read;
-+
-+               down(&msblk->read_page_mutex);
-+               
-+               if (!(bytes = squashfs_read_data(inode->i_sb, msblk->read_page,
-+                                       block, bsize, NULL))) {
-+                       ERROR("Unable to read page, block %llx, size %x\n", block,
-+                                       bsize);
-+                       up(&msblk->read_page_mutex);
-+                       goto skip_read;
-+               }
-+       } else {
-+               if ((fragment = get_cached_fragment(inode->i_sb,
-+                                       SQUASHFS_I(inode)->
-+                                       u.s1.fragment_start_block,
-+                                       SQUASHFS_I(inode)->u.s1.fragment_size))
-+                                       == NULL) {
-+                       ERROR("Unable to read page, block %llx, size %x\n",
-+                                       SQUASHFS_I(inode)->
-+                                       u.s1.fragment_start_block,
-+                                       (int) SQUASHFS_I(inode)->
-+                                       u.s1.fragment_size);
-+                       goto skip_read;
-+               }
-+               bytes = SQUASHFS_I(inode)->u.s1.fragment_offset +
-+                                       (i_size_read(inode) & (sblk->block_size
-+                                       - 1));
-+               byte_offset = SQUASHFS_I(inode)->u.s1.fragment_offset;
-+               data_ptr = fragment->data;
-+       }
-+
-+       for (i = start_index; i <= end_index && byte_offset < bytes;
-+                                       i++, byte_offset += PAGE_CACHE_SIZE) {
-+               struct page *push_page;
-+               int available_bytes = (bytes - byte_offset) > PAGE_CACHE_SIZE ?
-+                                       PAGE_CACHE_SIZE : bytes - byte_offset;
-+
-+               TRACE("bytes %d, i %d, byte_offset %d, available_bytes %d\n",
-+                                       bytes, i, byte_offset, available_bytes);
-+
-+               if (i == page->index)  {
-+                       pageaddr = kmap_atomic(page, KM_USER0);
-+                       memcpy(pageaddr, data_ptr + byte_offset,
-+                                       available_bytes);
-+                       memset(pageaddr + available_bytes, 0,
-+                                       PAGE_CACHE_SIZE - available_bytes);
-+                       kunmap_atomic(pageaddr, KM_USER0);
-+                       flush_dcache_page(page);
-+                       SetPageUptodate(page);
-+                       unlock_page(page);
-+               } else if ((push_page =
-+                               grab_cache_page_nowait(page->mapping, i))) {
-+                       pageaddr = kmap_atomic(push_page, KM_USER0);
-+
-+                       memcpy(pageaddr, data_ptr + byte_offset,
-+                                       available_bytes);
-+                       memset(pageaddr + available_bytes, 0,
-+                                       PAGE_CACHE_SIZE - available_bytes);
-+                       kunmap_atomic(pageaddr, KM_USER0);
-+                       flush_dcache_page(push_page);
-+                       SetPageUptodate(push_page);
-+                       unlock_page(push_page);
-+                       page_cache_release(push_page);
-+               }
-+       }
-+
-+       if (SQUASHFS_I(inode)->u.s1.fragment_start_block == SQUASHFS_INVALID_BLK
-+                                       || index < (i_size_read(inode) >>
-+                                       sblk->block_log))
-+               up(&msblk->read_page_mutex);
-+       else
-+               release_cached_fragment(msblk, fragment);
-+
-+       return 0;
-+
-+skip_read:
-+       pageaddr = kmap_atomic(page, KM_USER0);
-+       memset(pageaddr + bytes, 0, PAGE_CACHE_SIZE - bytes);
-+       kunmap_atomic(pageaddr, KM_USER0);
-+       flush_dcache_page(page);
-+       SetPageUptodate(page);
-+       unlock_page(page);
-+
-+       return 0;
-+}
-+
-+
-+static int squashfs_readpage4K(struct file *file, struct page *page)
-+{
-+       struct inode *inode = page->mapping->host;
-+       struct squashfs_sb_info *msblk = inode->i_sb->s_fs_info;
-+       struct squashfs_super_block *sblk = &msblk->sblk;
-+       unsigned char block_list[SIZE];
-+       long long block;
-+       unsigned int bsize, bytes = 0;
-+       void *pageaddr;
-+       
-+       TRACE("Entered squashfs_readpage4K, page index %lx, start block %llx\n",
-+                                       page->index,
-+                                       SQUASHFS_I(inode)->start_block);
-+
-+       if (page->index >= ((i_size_read(inode) + PAGE_CACHE_SIZE - 1) >>
-+                                       PAGE_CACHE_SHIFT)) {
-+               pageaddr = kmap_atomic(page, KM_USER0);
-+               goto skip_read;
-+       }
-+
-+       if (SQUASHFS_I(inode)->u.s1.fragment_start_block == SQUASHFS_INVALID_BLK
-+                                       || page->index < (i_size_read(inode) >>
-+                                       sblk->block_log)) {
-+               block = (msblk->read_blocklist)(inode, page->index, 1,
-+                                       block_list, NULL, &bsize);
-+
-+               down(&msblk->read_page_mutex);
-+               bytes = squashfs_read_data(inode->i_sb, msblk->read_page, block,
-+                                       bsize, NULL);
-+               pageaddr = kmap_atomic(page, KM_USER0);
-+               if (bytes)
-+                       memcpy(pageaddr, msblk->read_page, bytes);
-+               else
-+                       ERROR("Unable to read page, block %llx, size %x\n",
-+                                       block, bsize);
-+               up(&msblk->read_page_mutex);
-+       } else {
-+               struct squashfs_fragment_cache *fragment =
-+                       get_cached_fragment(inode->i_sb,
-+                                       SQUASHFS_I(inode)->
-+                                       u.s1.fragment_start_block,
-+                                       SQUASHFS_I(inode)-> u.s1.fragment_size);
-+               pageaddr = kmap_atomic(page, KM_USER0);
-+               if (fragment) {
-+                       bytes = i_size_read(inode) & (sblk->block_size - 1);
-+                       memcpy(pageaddr, fragment->data + SQUASHFS_I(inode)->
-+                                       u.s1.fragment_offset, bytes);
-+                       release_cached_fragment(msblk, fragment);
-+               } else
-+                       ERROR("Unable to read page, block %llx, size %x\n",
-+                                       SQUASHFS_I(inode)->
-+                                       u.s1.fragment_start_block, (int)
-+                                       SQUASHFS_I(inode)-> u.s1.fragment_size);
-+       }
-+
-+skip_read:
-+       memset(pageaddr + bytes, 0, PAGE_CACHE_SIZE - bytes);
-+       kunmap_atomic(pageaddr, KM_USER0);
-+       flush_dcache_page(page);
-+       SetPageUptodate(page);
-+       unlock_page(page);
-+
-+       return 0;
-+}
-+
-+
-+static int get_dir_index_using_offset(struct super_block *s, long long 
-+                               *next_block, unsigned int *next_offset,
-+                               long long index_start,
-+                               unsigned int index_offset, int i_count,
-+                               long long f_pos)
-+{
-+       struct squashfs_sb_info *msblk = s->s_fs_info;
-+       struct squashfs_super_block *sblk = &msblk->sblk;
-+       int i, length = 0;
-+       struct squashfs_dir_index index;
-+
-+       TRACE("Entered get_dir_index_using_offset, i_count %d, f_pos %d\n",
-+                                       i_count, (unsigned int) f_pos);
-+
-+       f_pos =- 3;
-+       if (f_pos == 0)
-+               goto finish;
-+
-+       for (i = 0; i < i_count; i++) {
-+               if (msblk->swap) {
-+                       struct squashfs_dir_index sindex;
-+                       squashfs_get_cached_block(s, (char *) &sindex,
-+                                       index_start, index_offset,
-+                                       sizeof(sindex), &index_start,
-+                                       &index_offset);
-+                       SQUASHFS_SWAP_DIR_INDEX(&index, &sindex);
-+               } else
-+                       squashfs_get_cached_block(s, (char *) &index,
-+                                       index_start, index_offset,
-+                                       sizeof(index), &index_start,
-+                                       &index_offset);
-+
-+               if (index.index > f_pos)
-+                       break;
-+
-+               squashfs_get_cached_block(s, NULL, index_start, index_offset,
-+                                       index.size + 1, &index_start,
-+                                       &index_offset);
-+
-+               length = index.index;
-+               *next_block = index.start_block + sblk->directory_table_start;
-+       }
-+
-+       *next_offset = (length + *next_offset) % SQUASHFS_METADATA_SIZE;
-+
-+finish:
-+       return length + 3;
-+}
-+
-+
-+static int get_dir_index_using_name(struct super_block *s, long long
-+                               *next_block, unsigned int *next_offset,
-+                               long long index_start,
-+                               unsigned int index_offset, int i_count,
-+                               const char *name, int size)
-+{
-+       struct squashfs_sb_info *msblk = s->s_fs_info;
-+       struct squashfs_super_block *sblk = &msblk->sblk;
-+       int i, length = 0;
-+       char buffer[sizeof(struct squashfs_dir_index) + SQUASHFS_NAME_LEN + 1];
-+       struct squashfs_dir_index *index = (struct squashfs_dir_index *) buffer;
-+       char str[SQUASHFS_NAME_LEN + 1];
-+
-+       TRACE("Entered get_dir_index_using_name, i_count %d\n", i_count);
-+
-+       strncpy(str, name, size);
-+       str[size] = '\0';
-+
-+       for (i = 0; i < i_count; i++) {
-+               if (msblk->swap) {
-+                       struct squashfs_dir_index sindex;
-+                       squashfs_get_cached_block(s, (char *) &sindex,
-+                                       index_start, index_offset,
-+                                       sizeof(sindex), &index_start,
-+                                       &index_offset);
-+                       SQUASHFS_SWAP_DIR_INDEX(index, &sindex);
-+               } else
-+                       squashfs_get_cached_block(s, (char *) index,
-+                                       index_start, index_offset,
-+                                       sizeof(struct squashfs_dir_index),
-+                                       &index_start, &index_offset);
-+
-+               squashfs_get_cached_block(s, index->name, index_start,
-+                                       index_offset, index->size + 1,
-+                                       &index_start, &index_offset);
-+
-+               index->name[index->size + 1] = '\0';
-+
-+               if (strcmp(index->name, str) > 0)
-+                       break;
-+
-+               length = index->index;
-+               *next_block = index->start_block + sblk->directory_table_start;
-+       }
-+
-+       *next_offset = (length + *next_offset) % SQUASHFS_METADATA_SIZE;
-+       return length + 3;
-+}
-+
-+               
-+static int squashfs_readdir(struct file *file, void *dirent, filldir_t filldir)
-+{
-+       struct inode *i = file->f_dentry->d_inode;
-+       struct squashfs_sb_info *msblk = i->i_sb->s_fs_info;
-+       struct squashfs_super_block *sblk = &msblk->sblk;
-+       long long next_block = SQUASHFS_I(i)->start_block +
-+               sblk->directory_table_start;
-+       int next_offset = SQUASHFS_I(i)->offset, length = 0, dirs_read = 0,
-+               dir_count;
-+       struct squashfs_dir_header dirh;
-+       char buffer[sizeof(struct squashfs_dir_entry) + SQUASHFS_NAME_LEN + 1];
-+       struct squashfs_dir_entry *dire = (struct squashfs_dir_entry *) buffer;
-+
-+       TRACE("Entered squashfs_readdir [%llx:%x]\n", next_block, next_offset);
-+
-+       while(file->f_pos < 3) {
-+               char *name;
-+               int size, i_ino;
-+
-+               if(file->f_pos == 0) {
-+                       name = ".";
-+                       size = 1;
-+                       i_ino = i->i_ino;
-+               } else {
-+                       name = "..";
-+                       size = 2;
-+                       i_ino = SQUASHFS_I(i)->u.s2.parent_inode;
-+               }
-+               TRACE("Calling filldir(%x, %s, %d, %d, %d, %d)\n",
-+                               (unsigned int) dirent, name, size, (int)
-+                               file->f_pos, i_ino,
-+                               squashfs_filetype_table[1]);
-+
-+               if (filldir(dirent, name, size,
-+                               file->f_pos, i_ino,
-+                               squashfs_filetype_table[1]) < 0) {
-+                               TRACE("Filldir returned less than 0\n");
-+                               goto finish;
-+               }
-+               file->f_pos += size;
-+               dirs_read++;
-+       }
-+
-+       length = get_dir_index_using_offset(i->i_sb, &next_block, &next_offset,
-+                               SQUASHFS_I(i)->u.s2.directory_index_start,
-+                               SQUASHFS_I(i)->u.s2.directory_index_offset,
-+                               SQUASHFS_I(i)->u.s2.directory_index_count,
-+                               file->f_pos);
-+
-+       while (length < i_size_read(i)) {
-+               /* read directory header */
-+               if (msblk->swap) {
-+                       struct squashfs_dir_header sdirh;
-+                       
-+                       if (!squashfs_get_cached_block(i->i_sb, (char *) &sdirh,
-+                                       next_block, next_offset, sizeof(sdirh),
-+                                       &next_block, &next_offset))
-+                               goto failed_read;
-+
-+                       length += sizeof(sdirh);
-+                       SQUASHFS_SWAP_DIR_HEADER(&dirh, &sdirh);
-+               } else {
-+                       if (!squashfs_get_cached_block(i->i_sb, (char *) &dirh,
-+                                       next_block, next_offset, sizeof(dirh),
-+                                       &next_block, &next_offset))
-+                               goto failed_read;
-+
-+                       length += sizeof(dirh);
-+               }
-+
-+               dir_count = dirh.count + 1;
-+               while (dir_count--) {
-+                       if (msblk->swap) {
-+                               struct squashfs_dir_entry sdire;
-+                               if (!squashfs_get_cached_block(i->i_sb, (char *)
-+                                               &sdire, next_block, next_offset,
-+                                               sizeof(sdire), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+                               
-+                               length += sizeof(sdire);
-+                               SQUASHFS_SWAP_DIR_ENTRY(dire, &sdire);
-+                       } else {
-+                               if (!squashfs_get_cached_block(i->i_sb, (char *)
-+                                               dire, next_block, next_offset,
-+                                               sizeof(*dire), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+
-+                               length += sizeof(*dire);
-+                       }
-+
-+                       if (!squashfs_get_cached_block(i->i_sb, dire->name,
-+                                               next_block, next_offset,
-+                                               dire->size + 1, &next_block,
-+                                               &next_offset))
-+                               goto failed_read;
-+
-+                       length += dire->size + 1;
-+
-+                       if (file->f_pos >= length)
-+                               continue;
-+
-+                       dire->name[dire->size + 1] = '\0';
-+
-+                       TRACE("Calling filldir(%x, %s, %d, %d, %x:%x, %d, %d)\n",
-+                                       (unsigned int) dirent, dire->name,
-+                                       dire->size + 1, (int) file->f_pos,
-+                                       dirh.start_block, dire->offset,
-+                                       dirh.inode_number + dire->inode_number,
-+                                       squashfs_filetype_table[dire->type]);
-+
-+                       if (filldir(dirent, dire->name, dire->size + 1,
-+                                       file->f_pos,
-+                                       dirh.inode_number + dire->inode_number,
-+                                       squashfs_filetype_table[dire->type])
-+                                       < 0) {
-+                               TRACE("Filldir returned less than 0\n");
-+                               goto finish;
-+                       }
-+                       file->f_pos = length;
-+                       dirs_read++;
-+               }
-+       }
-+
-+finish:
-+       return dirs_read;
-+
-+failed_read:
-+       ERROR("Unable to read directory block [%llx:%x]\n", next_block,
-+               next_offset);
-+       return 0;
-+}
-+
-+
-+static struct dentry *squashfs_lookup(struct inode *i, struct dentry *dentry,
-+                               struct nameidata *nd)
-+{
-+       const unsigned char *name = dentry->d_name.name;
-+       int len = dentry->d_name.len;
-+       struct inode *inode = NULL;
-+       struct squashfs_sb_info *msblk = i->i_sb->s_fs_info;
-+       struct squashfs_super_block *sblk = &msblk->sblk;
-+       long long next_block = SQUASHFS_I(i)->start_block +
-+                               sblk->directory_table_start;
-+       int next_offset = SQUASHFS_I(i)->offset, length = 0,
-+                               dir_count;
-+       struct squashfs_dir_header dirh;
-+       char buffer[sizeof(struct squashfs_dir_entry) + SQUASHFS_NAME_LEN];
-+       struct squashfs_dir_entry *dire = (struct squashfs_dir_entry *) buffer;
-+
-+       TRACE("Entered squashfs_lookup [%llx:%x]\n", next_block, next_offset);
-+
-+       if (len > SQUASHFS_NAME_LEN)
-+               goto exit_loop;
-+
-+       length = get_dir_index_using_name(i->i_sb, &next_block, &next_offset,
-+                               SQUASHFS_I(i)->u.s2.directory_index_start,
-+                               SQUASHFS_I(i)->u.s2.directory_index_offset,
-+                               SQUASHFS_I(i)->u.s2.directory_index_count, name,
-+                               len);
-+
-+       while (length < i_size_read(i)) {
-+               /* read directory header */
-+               if (msblk->swap) {
-+                       struct squashfs_dir_header sdirh;
-+                       if (!squashfs_get_cached_block(i->i_sb, (char *) &sdirh,
-+                                       next_block, next_offset, sizeof(sdirh),
-+                                       &next_block, &next_offset))
-+                               goto failed_read;
-+
-+                       length += sizeof(sdirh);
-+                       SQUASHFS_SWAP_DIR_HEADER(&dirh, &sdirh);
-+               } else {
-+                       if (!squashfs_get_cached_block(i->i_sb, (char *) &dirh,
-+                                       next_block, next_offset, sizeof(dirh),
-+                                       &next_block, &next_offset))
-+                               goto failed_read;
-+
-+                       length += sizeof(dirh);
-+               }
-+
-+               dir_count = dirh.count + 1;
-+               while (dir_count--) {
-+                       if (msblk->swap) {
-+                               struct squashfs_dir_entry sdire;
-+                               if (!squashfs_get_cached_block(i->i_sb, (char *)
-+                                               &sdire, next_block,next_offset,
-+                                               sizeof(sdire), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+                               
-+                               length += sizeof(sdire);
-+                               SQUASHFS_SWAP_DIR_ENTRY(dire, &sdire);
-+                       } else {
-+                               if (!squashfs_get_cached_block(i->i_sb, (char *)
-+                                               dire, next_block,next_offset,
-+                                               sizeof(*dire), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+
-+                               length += sizeof(*dire);
-+                       }
-+
-+                       if (!squashfs_get_cached_block(i->i_sb, dire->name,
-+                                       next_block, next_offset, dire->size + 1,
-+                                       &next_block, &next_offset))
-+                               goto failed_read;
-+
-+                       length += dire->size + 1;
-+
-+                       if (name[0] < dire->name[0])
-+                               goto exit_loop;
-+
-+                       if ((len == dire->size + 1) && !strncmp(name,
-+                                               dire->name, len)) {
-+                               squashfs_inode_t ino =
-+                                       SQUASHFS_MKINODE(dirh.start_block,
-+                                       dire->offset);
-+
-+                               TRACE("calling squashfs_iget for directory "
-+                                       "entry %s, inode %x:%x, %d\n", name,
-+                                       dirh.start_block, dire->offset,
-+                                       dirh.inode_number + dire->inode_number);
-+
-+                               inode = (msblk->iget)(i->i_sb, ino);
-+
-+                               goto exit_loop;
-+                       }
-+               }
-+       }
-+
-+exit_loop:
-+       d_add(dentry, inode);
-+       return ERR_PTR(0);
-+
-+failed_read:
-+       ERROR("Unable to read directory block [%llx:%x]\n", next_block,
-+               next_offset);
-+       goto exit_loop;
-+}
-+
-+
-+static void squashfs_put_super(struct super_block *s)
-+{
-+       int i;
-+
-+       if (s->s_fs_info) {
-+               struct squashfs_sb_info *sbi = s->s_fs_info;
-+               if (sbi->block_cache)
-+                       for (i = 0; i < SQUASHFS_CACHED_BLKS; i++)
-+                               if (sbi->block_cache[i].block !=
-+                                                       SQUASHFS_INVALID_BLK)
-+                                       kfree(sbi->block_cache[i].data);
-+               if (sbi->fragment)
-+                       for (i = 0; i < SQUASHFS_CACHED_FRAGMENTS; i++) 
-+                               SQUASHFS_FREE(sbi->fragment[i].data);
-+               kfree(sbi->fragment);
-+               kfree(sbi->block_cache);
-+               kfree(sbi->read_data);
-+               kfree(sbi->read_page);
-+               kfree(sbi->uid);
-+               kfree(sbi->fragment_index);
-+               kfree(sbi->fragment_index_2);
-+               kfree(sbi->meta_index);
-+               kfree(s->s_fs_info);
-+               s->s_fs_info = NULL;
-+       }
-+}
-+
-+
-+static int squashfs_get_sb(struct file_system_type *fs_type,
-+                               int flags, const char *dev_name, void *data, struct vfsmount *mnt)
-+{
-+       return get_sb_bdev(fs_type, flags, dev_name, data, squashfs_fill_super, mnt);
-+}
-+
-+
-+static int __init init_squashfs_fs(void)
-+{
-+       int err = init_inodecache();
-+       if (err)
-+               goto out;
-+
-+       printk(KERN_INFO "squashfs: version 3.0 (2006/03/15) "
-+               "Phillip Lougher\n");
-+
-+       if (!(stream.workspace = vmalloc(zlib_inflate_workspacesize()))) {
-+               ERROR("Failed to allocate zlib workspace\n");
-+               destroy_inodecache();
-+               err = -ENOMEM;
-+               goto out;
-+       }
-+
-+       if ((err = register_filesystem(&squashfs_fs_type))) {
-+               vfree(stream.workspace);
-+               destroy_inodecache();
-+       }
-+
-+out:
-+       return err;
-+}
-+
-+
-+static void __exit exit_squashfs_fs(void)
-+{
-+       vfree(stream.workspace);
-+       unregister_filesystem(&squashfs_fs_type);
-+       destroy_inodecache();
-+}
-+
-+
-+static struct kmem_cache* squashfs_inode_cachep;
-+
-+
-+static struct inode *squashfs_alloc_inode(struct super_block *sb)
-+{
-+       struct squashfs_inode_info *ei;
-+       ei = kmem_cache_alloc(squashfs_inode_cachep, GFP_KERNEL);
-+       if (!ei)
-+               return NULL;
-+       return &ei->vfs_inode;
-+}
-+
-+
-+static void squashfs_destroy_inode(struct inode *inode)
-+{
-+       kmem_cache_free(squashfs_inode_cachep, SQUASHFS_I(inode));
-+}
-+
-+
-+static void init_once(void * foo, struct kmem_cache *cachep, unsigned long flags)
-+{
-+       struct squashfs_inode_info *ei = foo;
-+
-+       inode_init_once(&ei->vfs_inode);
-+}
-+ 
-+
-+static int __init init_inodecache(void)
-+{
-+       squashfs_inode_cachep = kmem_cache_create("squashfs_inode_cache",
-+            sizeof(struct squashfs_inode_info),
-+            0, SLAB_HWCACHE_ALIGN|SLAB_RECLAIM_ACCOUNT,
-+            init_once);
-+       if (squashfs_inode_cachep == NULL)
-+               return -ENOMEM;
-+       return 0;
-+}
-+
-+
-+static void destroy_inodecache(void)
-+{
-+       kmem_cache_destroy(squashfs_inode_cachep);
-+}
-+
-+
-+module_init(init_squashfs_fs);
-+module_exit(exit_squashfs_fs);
-+MODULE_DESCRIPTION("squashfs, a compressed read-only filesystem");
-+MODULE_AUTHOR("Phillip Lougher <phillip@lougher.org.uk>");
-Index: linux-2.6.22/fs/squashfs/Makefile
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/fs/squashfs/Makefile   2007-08-28 21:56:34.000000000 +0100
-@@ -0,0 +1,7 @@
-+#
-+# Makefile for the linux squashfs routines.
-+#
-+
-+obj-$(CONFIG_SQUASHFS) += squashfs.o
-+squashfs-y += inode.o
-+squashfs-y += squashfs2_0.o
-Index: linux-2.6.22/fs/squashfs/squashfs2_0.c
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/fs/squashfs/squashfs2_0.c      2007-08-28 21:56:34.000000000 +0100
-@@ -0,0 +1,757 @@
-+/*
-+ * Squashfs - a compressed read only filesystem for Linux
-+ *
-+ * Copyright (c) 2002, 2003, 2004, 2005, 2006
-+ * Phillip Lougher <phillip@lougher.org.uk>
-+ *
-+ * 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,
-+ * 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, 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
-+ *
-+ * squashfs2_0.c
-+ */
-+
-+#include <linux/types.h>
-+#include <linux/squashfs_fs.h>
-+#include <linux/module.h>
-+#include <linux/errno.h>
-+#include <linux/slab.h>
-+#include <linux/fs.h>
-+#include <linux/smp_lock.h>
-+#include <linux/slab.h>
-+#include <linux/squashfs_fs_sb.h>
-+#include <linux/squashfs_fs_i.h>
-+#include <linux/buffer_head.h>
-+#include <linux/vfs.h>
-+#include <linux/init.h>
-+#include <linux/dcache.h>
-+#include <linux/wait.h>
-+#include <linux/zlib.h>
-+#include <linux/blkdev.h>
-+#include <linux/vmalloc.h>
-+#include <asm/uaccess.h>
-+#include <asm/semaphore.h>
-+
-+#include "squashfs.h"
-+static int squashfs_readdir_2(struct file *file, void *dirent, filldir_t filldir);
-+static struct dentry *squashfs_lookup_2(struct inode *, struct dentry *,
-+                               struct nameidata *);
-+
-+static struct file_operations squashfs_dir_ops_2 = {
-+       .read = generic_read_dir,
-+       .readdir = squashfs_readdir_2
-+};
-+
-+static struct inode_operations squashfs_dir_inode_ops_2 = {
-+       .lookup = squashfs_lookup_2
-+};
-+
-+static unsigned char squashfs_filetype_table[] = {
-+       DT_UNKNOWN, DT_DIR, DT_REG, DT_LNK, DT_BLK, DT_CHR, DT_FIFO, DT_SOCK
-+};
-+
-+static int read_fragment_index_table_2(struct super_block *s)
-+{
-+       struct squashfs_sb_info *msblk = s->s_fs_info;
-+       struct squashfs_super_block *sblk = &msblk->sblk;
-+
-+       if (!(msblk->fragment_index_2 = kmalloc(SQUASHFS_FRAGMENT_INDEX_BYTES_2
-+                                       (sblk->fragments), GFP_KERNEL))) {
-+               ERROR("Failed to allocate uid/gid table\n");
-+               return 0;
-+       }
-+   
-+       if (SQUASHFS_FRAGMENT_INDEX_BYTES_2(sblk->fragments) &&
-+                                       !squashfs_read_data(s, (char *)
-+                                       msblk->fragment_index_2,
-+                                       sblk->fragment_table_start,
-+                                       SQUASHFS_FRAGMENT_INDEX_BYTES_2
-+                                       (sblk->fragments) |
-+                                       SQUASHFS_COMPRESSED_BIT_BLOCK, NULL)) {
-+               ERROR("unable to read fragment index table\n");
-+               return 0;
-+       }
-+
-+       if (msblk->swap) {
-+               int i;
-+               unsigned int fragment;
-+
-+               for (i = 0; i < SQUASHFS_FRAGMENT_INDEXES_2(sblk->fragments);
-+                                                                       i++) {
-+                       SQUASHFS_SWAP_FRAGMENT_INDEXES_2((&fragment),
-+                                               &msblk->fragment_index_2[i], 1);
-+                       msblk->fragment_index_2[i] = fragment;
-+               }
-+       }
-+
-+       return 1;
-+}
-+
-+
-+static int get_fragment_location_2(struct super_block *s, unsigned int fragment,
-+                               long long *fragment_start_block,
-+                               unsigned int *fragment_size)
-+{
-+       struct squashfs_sb_info *msblk = s->s_fs_info;
-+       long long start_block =
-+               msblk->fragment_index_2[SQUASHFS_FRAGMENT_INDEX_2(fragment)];
-+       int offset = SQUASHFS_FRAGMENT_INDEX_OFFSET_2(fragment);
-+       struct squashfs_fragment_entry_2 fragment_entry;
-+
-+       if (msblk->swap) {
-+               struct squashfs_fragment_entry_2 sfragment_entry;
-+
-+               if (!squashfs_get_cached_block(s, (char *) &sfragment_entry,
-+                                       start_block, offset,
-+                                       sizeof(sfragment_entry), &start_block,
-+                                       &offset))
-+                       goto out;
-+               SQUASHFS_SWAP_FRAGMENT_ENTRY_2(&fragment_entry, &sfragment_entry);
-+       } else
-+               if (!squashfs_get_cached_block(s, (char *) &fragment_entry,
-+                                       start_block, offset,
-+                                       sizeof(fragment_entry), &start_block,
-+                                       &offset))
-+                       goto out;
-+
-+       *fragment_start_block = fragment_entry.start_block;
-+       *fragment_size = fragment_entry.size;
-+
-+       return 1;
-+
-+out:
-+       return 0;
-+}
-+
-+
-+static struct inode *squashfs_new_inode(struct super_block *s,
-+               struct squashfs_base_inode_header_2 *inodeb, unsigned int ino)
-+{
-+       struct squashfs_sb_info *msblk = s->s_fs_info;
-+       struct squashfs_super_block *sblk = &msblk->sblk;
-+       struct inode *i = new_inode(s);
-+
-+       if (i) {
-+               i->i_ino = ino;
-+               i->i_mtime.tv_sec = sblk->mkfs_time;
-+               i->i_atime.tv_sec = sblk->mkfs_time;
-+               i->i_ctime.tv_sec = sblk->mkfs_time;
-+               i->i_uid = msblk->uid[inodeb->uid];
-+               i->i_mode = inodeb->mode;
-+               i->i_nlink = 1;
-+               i->i_size = 0;
-+               if (inodeb->guid == SQUASHFS_GUIDS)
-+                       i->i_gid = i->i_uid;
-+               else
-+                       i->i_gid = msblk->guid[inodeb->guid];
-+       }
-+
-+       return i;
-+}
-+
-+
-+static struct inode *squashfs_iget_2(struct super_block *s, squashfs_inode_t inode)
-+{
-+       struct inode *i;
-+       struct squashfs_sb_info *msblk = s->s_fs_info;
-+       struct squashfs_super_block *sblk = &msblk->sblk;
-+       unsigned int block = SQUASHFS_INODE_BLK(inode) +
-+               sblk->inode_table_start;
-+       unsigned int offset = SQUASHFS_INODE_OFFSET(inode);
-+       unsigned int ino = SQUASHFS_MK_VFS_INODE(block
-+               - sblk->inode_table_start, offset);
-+       long long next_block;
-+       unsigned int next_offset;
-+       union squashfs_inode_header_2 id, sid;
-+       struct squashfs_base_inode_header_2 *inodeb = &id.base,
-+                                         *sinodeb = &sid.base;
-+
-+       TRACE("Entered squashfs_iget\n");
-+
-+       if (msblk->swap) {
-+               if (!squashfs_get_cached_block(s, (char *) sinodeb, block,
-+                                       offset, sizeof(*sinodeb), &next_block,
-+                                       &next_offset))
-+                       goto failed_read;
-+               SQUASHFS_SWAP_BASE_INODE_HEADER_2(inodeb, sinodeb,
-+                                       sizeof(*sinodeb));
-+       } else
-+               if (!squashfs_get_cached_block(s, (char *) inodeb, block,
-+                                       offset, sizeof(*inodeb), &next_block,
-+                                       &next_offset))
-+                       goto failed_read;
-+
-+       switch(inodeb->inode_type) {
-+               case SQUASHFS_FILE_TYPE: {
-+                       struct squashfs_reg_inode_header_2 *inodep = &id.reg;
-+                       struct squashfs_reg_inode_header_2 *sinodep = &sid.reg;
-+                       long long frag_blk;
-+                       unsigned int frag_size;
-+                               
-+                       if (msblk->swap) {
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               sinodep, block, offset,
-+                                               sizeof(*sinodep), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+                               SQUASHFS_SWAP_REG_INODE_HEADER_2(inodep, sinodep);
-+                       } else
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               inodep, block, offset,
-+                                               sizeof(*inodep), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+
-+                       frag_blk = SQUASHFS_INVALID_BLK;
-+                       if (inodep->fragment != SQUASHFS_INVALID_FRAG &&
-+                                       !get_fragment_location_2(s,
-+                                       inodep->fragment, &frag_blk, &frag_size))
-+                               goto failed_read;
-+                               
-+                       if((i = squashfs_new_inode(s, inodeb, ino)) == NULL)
-+                               goto failed_read1;
-+
-+                       i->i_size = inodep->file_size;
-+                       i->i_fop = &generic_ro_fops;
-+                       i->i_mode |= S_IFREG;
-+                       i->i_mtime.tv_sec = inodep->mtime;
-+                       i->i_atime.tv_sec = inodep->mtime;
-+                       i->i_ctime.tv_sec = inodep->mtime;
-+                       i->i_blocks = ((i->i_size - 1) >> 9) + 1;
-+                       SQUASHFS_I(i)->u.s1.fragment_start_block = frag_blk;
-+                       SQUASHFS_I(i)->u.s1.fragment_size = frag_size;
-+                       SQUASHFS_I(i)->u.s1.fragment_offset = inodep->offset;
-+                       SQUASHFS_I(i)->start_block = inodep->start_block;
-+                       SQUASHFS_I(i)->u.s1.block_list_start = next_block;
-+                       SQUASHFS_I(i)->offset = next_offset;
-+                       if (sblk->block_size > 4096)
-+                               i->i_data.a_ops = &squashfs_aops;
-+                       else
-+                               i->i_data.a_ops = &squashfs_aops_4K;
-+
-+                       TRACE("File inode %x:%x, start_block %x, "
-+                                       "block_list_start %llx, offset %x\n",
-+                                       SQUASHFS_INODE_BLK(inode), offset,
-+                                       inodep->start_block, next_block,
-+                                       next_offset);
-+                       break;
-+               }
-+               case SQUASHFS_DIR_TYPE: {
-+                       struct squashfs_dir_inode_header_2 *inodep = &id.dir;
-+                       struct squashfs_dir_inode_header_2 *sinodep = &sid.dir;
-+
-+                       if (msblk->swap) {
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               sinodep, block, offset,
-+                                               sizeof(*sinodep), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+                               SQUASHFS_SWAP_DIR_INODE_HEADER_2(inodep, sinodep);
-+                       } else
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               inodep, block, offset,
-+                                               sizeof(*inodep), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+
-+                       if((i = squashfs_new_inode(s, inodeb, ino)) == NULL)
-+                               goto failed_read1;
-+
-+                       i->i_size = inodep->file_size;
-+                       i->i_op = &squashfs_dir_inode_ops_2;
-+                       i->i_fop = &squashfs_dir_ops_2;
-+                       i->i_mode |= S_IFDIR;
-+                       i->i_mtime.tv_sec = inodep->mtime;
-+                       i->i_atime.tv_sec = inodep->mtime;
-+                       i->i_ctime.tv_sec = inodep->mtime;
-+                       SQUASHFS_I(i)->start_block = inodep->start_block;
-+                       SQUASHFS_I(i)->offset = inodep->offset;
-+                       SQUASHFS_I(i)->u.s2.directory_index_count = 0;
-+                       SQUASHFS_I(i)->u.s2.parent_inode = 0;
-+
-+                       TRACE("Directory inode %x:%x, start_block %x, offset "
-+                                       "%x\n", SQUASHFS_INODE_BLK(inode),
-+                                       offset, inodep->start_block,
-+                                       inodep->offset);
-+                       break;
-+               }
-+               case SQUASHFS_LDIR_TYPE: {
-+                       struct squashfs_ldir_inode_header_2 *inodep = &id.ldir;
-+                       struct squashfs_ldir_inode_header_2 *sinodep = &sid.ldir;
-+
-+                       if (msblk->swap) {
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               sinodep, block, offset,
-+                                               sizeof(*sinodep), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+                               SQUASHFS_SWAP_LDIR_INODE_HEADER_2(inodep,
-+                                               sinodep);
-+                       } else
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               inodep, block, offset,
-+                                               sizeof(*inodep), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+
-+                       if((i = squashfs_new_inode(s, inodeb, ino)) == NULL)
-+                               goto failed_read1;
-+
-+                       i->i_size = inodep->file_size;
-+                       i->i_op = &squashfs_dir_inode_ops_2;
-+                       i->i_fop = &squashfs_dir_ops_2;
-+                       i->i_mode |= S_IFDIR;
-+                       i->i_mtime.tv_sec = inodep->mtime;
-+                       i->i_atime.tv_sec = inodep->mtime;
-+                       i->i_ctime.tv_sec = inodep->mtime;
-+                       SQUASHFS_I(i)->start_block = inodep->start_block;
-+                       SQUASHFS_I(i)->offset = inodep->offset;
-+                       SQUASHFS_I(i)->u.s2.directory_index_start = next_block;
-+                       SQUASHFS_I(i)->u.s2.directory_index_offset =
-+                                                               next_offset;
-+                       SQUASHFS_I(i)->u.s2.directory_index_count =
-+                                                               inodep->i_count;
-+                       SQUASHFS_I(i)->u.s2.parent_inode = 0;
-+
-+                       TRACE("Long directory inode %x:%x, start_block %x, "
-+                                       "offset %x\n",
-+                                       SQUASHFS_INODE_BLK(inode), offset,
-+                                       inodep->start_block, inodep->offset);
-+                       break;
-+               }
-+               case SQUASHFS_SYMLINK_TYPE: {
-+                       struct squashfs_symlink_inode_header_2 *inodep =
-+                                                               &id.symlink;
-+                       struct squashfs_symlink_inode_header_2 *sinodep =
-+                                                               &sid.symlink;
-+       
-+                       if (msblk->swap) {
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               sinodep, block, offset,
-+                                               sizeof(*sinodep), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+                               SQUASHFS_SWAP_SYMLINK_INODE_HEADER_2(inodep,
-+                                                               sinodep);
-+                       } else
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               inodep, block, offset,
-+                                               sizeof(*inodep), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+
-+                       if((i = squashfs_new_inode(s, inodeb, ino)) == NULL)
-+                               goto failed_read1;
-+
-+                       i->i_size = inodep->symlink_size;
-+                       i->i_op = &page_symlink_inode_operations;
-+                       i->i_data.a_ops = &squashfs_symlink_aops;
-+                       i->i_mode |= S_IFLNK;
-+                       SQUASHFS_I(i)->start_block = next_block;
-+                       SQUASHFS_I(i)->offset = next_offset;
-+
-+                       TRACE("Symbolic link inode %x:%x, start_block %llx, "
-+                                       "offset %x\n",
-+                                       SQUASHFS_INODE_BLK(inode), offset,
-+                                       next_block, next_offset);
-+                       break;
-+                }
-+                case SQUASHFS_BLKDEV_TYPE:
-+                case SQUASHFS_CHRDEV_TYPE: {
-+                       struct squashfs_dev_inode_header_2 *inodep = &id.dev;
-+                       struct squashfs_dev_inode_header_2 *sinodep = &sid.dev;
-+
-+                       if (msblk->swap) {
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               sinodep, block, offset,
-+                                               sizeof(*sinodep), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+                               SQUASHFS_SWAP_DEV_INODE_HEADER_2(inodep, sinodep);
-+                       } else  
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               inodep, block, offset,
-+                                               sizeof(*inodep), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+
-+                       if ((i = squashfs_new_inode(s, inodeb, ino)) == NULL)
-+                               goto failed_read1;
-+
-+                       i->i_mode |= (inodeb->inode_type ==
-+                                       SQUASHFS_CHRDEV_TYPE) ?  S_IFCHR :
-+                                       S_IFBLK;
-+                       init_special_inode(i, i->i_mode,
-+                                       old_decode_dev(inodep->rdev));
-+
-+                       TRACE("Device inode %x:%x, rdev %x\n",
-+                                       SQUASHFS_INODE_BLK(inode), offset,
-+                                       inodep->rdev);
-+                       break;
-+                }
-+                case SQUASHFS_FIFO_TYPE:
-+                case SQUASHFS_SOCKET_TYPE: {
-+                       if ((i = squashfs_new_inode(s, inodeb, ino)) == NULL)
-+                               goto failed_read1;
-+
-+                       i->i_mode |= (inodeb->inode_type == SQUASHFS_FIFO_TYPE)
-+                                                       ? S_IFIFO : S_IFSOCK;
-+                       init_special_inode(i, i->i_mode, 0);
-+                       break;
-+                }
-+                default:
-+                       ERROR("Unknown inode type %d in squashfs_iget!\n",
-+                                       inodeb->inode_type);
-+                       goto failed_read1;
-+       }
-+       
-+       insert_inode_hash(i);
-+       return i;
-+
-+failed_read:
-+       ERROR("Unable to read inode [%x:%x]\n", block, offset);
-+
-+failed_read1:
-+       return NULL;
-+}
-+
-+
-+static int get_dir_index_using_offset(struct super_block *s, long long 
-+                               *next_block, unsigned int *next_offset,
-+                               long long index_start,
-+                               unsigned int index_offset, int i_count,
-+                               long long f_pos)
-+{
-+       struct squashfs_sb_info *msblk = s->s_fs_info;
-+       struct squashfs_super_block *sblk = &msblk->sblk;
-+       int i, length = 0;
-+       struct squashfs_dir_index_2 index;
-+
-+       TRACE("Entered get_dir_index_using_offset, i_count %d, f_pos %d\n",
-+                                       i_count, (unsigned int) f_pos);
-+
-+       if (f_pos == 0)
-+               goto finish;
-+
-+       for (i = 0; i < i_count; i++) {
-+               if (msblk->swap) {
-+                       struct squashfs_dir_index_2 sindex;
-+                       squashfs_get_cached_block(s, (char *) &sindex,
-+                                       index_start, index_offset,
-+                                       sizeof(sindex), &index_start,
-+                                       &index_offset);
-+                       SQUASHFS_SWAP_DIR_INDEX_2(&index, &sindex);
-+               } else
-+                       squashfs_get_cached_block(s, (char *) &index,
-+                                       index_start, index_offset,
-+                                       sizeof(index), &index_start,
-+                                       &index_offset);
-+
-+               if (index.index > f_pos)
-+                       break;
-+
-+               squashfs_get_cached_block(s, NULL, index_start, index_offset,
-+                                       index.size + 1, &index_start,
-+                                       &index_offset);
-+
-+               length = index.index;
-+               *next_block = index.start_block + sblk->directory_table_start;
-+       }
-+
-+       *next_offset = (length + *next_offset) % SQUASHFS_METADATA_SIZE;
-+
-+finish:
-+       return length;
-+}
-+
-+
-+static int get_dir_index_using_name(struct super_block *s, long long
-+                               *next_block, unsigned int *next_offset,
-+                               long long index_start,
-+                               unsigned int index_offset, int i_count,
-+                               const char *name, int size)
-+{
-+       struct squashfs_sb_info *msblk = s->s_fs_info;
-+       struct squashfs_super_block *sblk = &msblk->sblk;
-+       int i, length = 0;
-+       char buffer[sizeof(struct squashfs_dir_index_2) + SQUASHFS_NAME_LEN + 1];
-+       struct squashfs_dir_index_2 *index = (struct squashfs_dir_index_2 *) buffer;
-+       char str[SQUASHFS_NAME_LEN + 1];
-+
-+       TRACE("Entered get_dir_index_using_name, i_count %d\n", i_count);
-+
-+       strncpy(str, name, size);
-+       str[size] = '\0';
-+
-+       for (i = 0; i < i_count; i++) {
-+               if (msblk->swap) {
-+                       struct squashfs_dir_index_2 sindex;
-+                       squashfs_get_cached_block(s, (char *) &sindex,
-+                                       index_start, index_offset,
-+                                       sizeof(sindex), &index_start,
-+                                       &index_offset);
-+                       SQUASHFS_SWAP_DIR_INDEX_2(index, &sindex);
-+               } else
-+                       squashfs_get_cached_block(s, (char *) index,
-+                                       index_start, index_offset,
-+                                       sizeof(struct squashfs_dir_index_2),
-+                                       &index_start, &index_offset);
-+
-+               squashfs_get_cached_block(s, index->name, index_start,
-+                                       index_offset, index->size + 1,
-+                                       &index_start, &index_offset);
-+
-+               index->name[index->size + 1] = '\0';
-+
-+               if (strcmp(index->name, str) > 0)
-+                       break;
-+
-+               length = index->index;
-+               *next_block = index->start_block + sblk->directory_table_start;
-+       }
-+
-+       *next_offset = (length + *next_offset) % SQUASHFS_METADATA_SIZE;
-+       return length;
-+}
-+
-+               
-+static int squashfs_readdir_2(struct file *file, void *dirent, filldir_t filldir)
-+{
-+       struct inode *i = file->f_dentry->d_inode;
-+       struct squashfs_sb_info *msblk = i->i_sb->s_fs_info;
-+       struct squashfs_super_block *sblk = &msblk->sblk;
-+       long long next_block = SQUASHFS_I(i)->start_block +
-+               sblk->directory_table_start;
-+       int next_offset = SQUASHFS_I(i)->offset, length = 0, dirs_read = 0,
-+               dir_count;
-+       struct squashfs_dir_header_2 dirh;
-+       char buffer[sizeof(struct squashfs_dir_entry_2) + SQUASHFS_NAME_LEN + 1];
-+       struct squashfs_dir_entry_2 *dire = (struct squashfs_dir_entry_2 *) buffer;
-+
-+       TRACE("Entered squashfs_readdir_2 [%llx:%x]\n", next_block, next_offset);
-+
-+       length = get_dir_index_using_offset(i->i_sb, &next_block, &next_offset,
-+                               SQUASHFS_I(i)->u.s2.directory_index_start,
-+                               SQUASHFS_I(i)->u.s2.directory_index_offset,
-+                               SQUASHFS_I(i)->u.s2.directory_index_count,
-+                               file->f_pos);
-+
-+       while (length < i_size_read(i)) {
-+               /* read directory header */
-+               if (msblk->swap) {
-+                       struct squashfs_dir_header_2 sdirh;
-+                       
-+                       if (!squashfs_get_cached_block(i->i_sb, (char *) &sdirh,
-+                                       next_block, next_offset, sizeof(sdirh),
-+                                       &next_block, &next_offset))
-+                               goto failed_read;
-+
-+                       length += sizeof(sdirh);
-+                       SQUASHFS_SWAP_DIR_HEADER_2(&dirh, &sdirh);
-+               } else {
-+                       if (!squashfs_get_cached_block(i->i_sb, (char *) &dirh,
-+                                       next_block, next_offset, sizeof(dirh),
-+                                       &next_block, &next_offset))
-+                               goto failed_read;
-+
-+                       length += sizeof(dirh);
-+               }
-+
-+               dir_count = dirh.count + 1;
-+               while (dir_count--) {
-+                       if (msblk->swap) {
-+                               struct squashfs_dir_entry_2 sdire;
-+                               if (!squashfs_get_cached_block(i->i_sb, (char *)
-+                                               &sdire, next_block, next_offset,
-+                                               sizeof(sdire), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+                               
-+                               length += sizeof(sdire);
-+                               SQUASHFS_SWAP_DIR_ENTRY_2(dire, &sdire);
-+                       } else {
-+                               if (!squashfs_get_cached_block(i->i_sb, (char *)
-+                                               dire, next_block, next_offset,
-+                                               sizeof(*dire), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+
-+                               length += sizeof(*dire);
-+                       }
-+
-+                       if (!squashfs_get_cached_block(i->i_sb, dire->name,
-+                                               next_block, next_offset,
-+                                               dire->size + 1, &next_block,
-+                                               &next_offset))
-+                               goto failed_read;
-+
-+                       length += dire->size + 1;
-+
-+                       if (file->f_pos >= length)
-+                               continue;
-+
-+                       dire->name[dire->size + 1] = '\0';
-+
-+                       TRACE("Calling filldir(%x, %s, %d, %d, %x:%x, %d)\n",
-+                                       (unsigned int) dirent, dire->name,
-+                                       dire->size + 1, (int) file->f_pos,
-+                                       dirh.start_block, dire->offset,
-+                                       squashfs_filetype_table[dire->type]);
-+
-+                       if (filldir(dirent, dire->name, dire->size + 1,
-+                                       file->f_pos, SQUASHFS_MK_VFS_INODE(
-+                                       dirh.start_block, dire->offset),
-+                                       squashfs_filetype_table[dire->type])
-+                                       < 0) {
-+                               TRACE("Filldir returned less than 0\n");
-+                               goto finish;
-+                       }
-+                       file->f_pos = length;
-+                       dirs_read++;
-+               }
-+       }
-+
-+finish:
-+       return dirs_read;
-+
-+failed_read:
-+       ERROR("Unable to read directory block [%llx:%x]\n", next_block,
-+               next_offset);
-+       return 0;
-+}
-+
-+
-+static struct dentry *squashfs_lookup_2(struct inode *i, struct dentry *dentry,
-+                               struct nameidata *nd)
-+{
-+       const unsigned char *name = dentry->d_name.name;
-+       int len = dentry->d_name.len;
-+       struct inode *inode = NULL;
-+       struct squashfs_sb_info *msblk = i->i_sb->s_fs_info;
-+       struct squashfs_super_block *sblk = &msblk->sblk;
-+       long long next_block = SQUASHFS_I(i)->start_block +
-+                               sblk->directory_table_start;
-+       int next_offset = SQUASHFS_I(i)->offset, length = 0,
-+                               dir_count;
-+       struct squashfs_dir_header_2 dirh;
-+       char buffer[sizeof(struct squashfs_dir_entry_2) + SQUASHFS_NAME_LEN];
-+       struct squashfs_dir_entry_2 *dire = (struct squashfs_dir_entry_2 *) buffer;
-+       int sorted = sblk->s_major == 2 && sblk->s_minor >= 1;
-+
-+       TRACE("Entered squashfs_lookup [%llx:%x]\n", next_block, next_offset);
-+
-+       if (len > SQUASHFS_NAME_LEN)
-+               goto exit_loop;
-+
-+       length = get_dir_index_using_name(i->i_sb, &next_block, &next_offset,
-+                               SQUASHFS_I(i)->u.s2.directory_index_start,
-+                               SQUASHFS_I(i)->u.s2.directory_index_offset,
-+                               SQUASHFS_I(i)->u.s2.directory_index_count, name,
-+                               len);
-+
-+       while (length < i_size_read(i)) {
-+               /* read directory header */
-+               if (msblk->swap) {
-+                       struct squashfs_dir_header_2 sdirh;
-+                       if (!squashfs_get_cached_block(i->i_sb, (char *) &sdirh,
-+                                       next_block, next_offset, sizeof(sdirh),
-+                                       &next_block, &next_offset))
-+                               goto failed_read;
-+
-+                       length += sizeof(sdirh);
-+                       SQUASHFS_SWAP_DIR_HEADER_2(&dirh, &sdirh);
-+               } else {
-+                       if (!squashfs_get_cached_block(i->i_sb, (char *) &dirh,
-+                                       next_block, next_offset, sizeof(dirh),
-+                                       &next_block, &next_offset))
-+                               goto failed_read;
-+
-+                       length += sizeof(dirh);
-+               }
-+
-+               dir_count = dirh.count + 1;
-+               while (dir_count--) {
-+                       if (msblk->swap) {
-+                               struct squashfs_dir_entry_2 sdire;
-+                               if (!squashfs_get_cached_block(i->i_sb, (char *)
-+                                               &sdire, next_block,next_offset,
-+                                               sizeof(sdire), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+                               
-+                               length += sizeof(sdire);
-+                               SQUASHFS_SWAP_DIR_ENTRY_2(dire, &sdire);
-+                       } else {
-+                               if (!squashfs_get_cached_block(i->i_sb, (char *)
-+                                               dire, next_block,next_offset,
-+                                               sizeof(*dire), &next_block,
-+                                               &next_offset))
-+                                       goto failed_read;
-+
-+                               length += sizeof(*dire);
-+                       }
-+
-+                       if (!squashfs_get_cached_block(i->i_sb, dire->name,
-+                                       next_block, next_offset, dire->size + 1,
-+                                       &next_block, &next_offset))
-+                               goto failed_read;
-+
-+                       length += dire->size + 1;
-+
-+                       if (sorted && name[0] < dire->name[0])
-+                               goto exit_loop;
-+
-+                       if ((len == dire->size + 1) && !strncmp(name,
-+                                               dire->name, len)) {
-+                               squashfs_inode_t ino =
-+                                       SQUASHFS_MKINODE(dirh.start_block,
-+                                       dire->offset);
-+
-+                               TRACE("calling squashfs_iget for directory "
-+                                       "entry %s, inode %x:%x, %lld\n", name,
-+                                       dirh.start_block, dire->offset, ino);
-+
-+                               inode = (msblk->iget)(i->i_sb, ino);
-+
-+                               goto exit_loop;
-+                       }
-+               }
-+       }
-+
-+exit_loop:
-+       d_add(dentry, inode);
-+       return ERR_PTR(0);
-+
-+failed_read:
-+       ERROR("Unable to read directory block [%llx:%x]\n", next_block,
-+               next_offset);
-+       goto exit_loop;
-+}
-+
-+
-+int squashfs_2_0_supported(struct squashfs_sb_info *msblk)
-+{
-+       struct squashfs_super_block *sblk = &msblk->sblk;
-+
-+       msblk->iget = squashfs_iget_2;
-+       msblk->read_fragment_index_table = read_fragment_index_table_2;
-+
-+       sblk->bytes_used = sblk->bytes_used_2;
-+       sblk->uid_start = sblk->uid_start_2;
-+       sblk->guid_start = sblk->guid_start_2;
-+       sblk->inode_table_start = sblk->inode_table_start_2;
-+       sblk->directory_table_start = sblk->directory_table_start_2;
-+       sblk->fragment_table_start = sblk->fragment_table_start_2;
-+
-+       return 1;
-+}
-Index: linux-2.6.22/fs/squashfs/squashfs.h
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/fs/squashfs/squashfs.h 2007-08-28 21:56:34.000000000 +0100
-@@ -0,0 +1,86 @@
-+/*
-+ * Squashfs - a compressed read only filesystem for Linux
-+ *
-+ * Copyright (c) 2002, 2003, 2004, 2005, 2006
-+ * Phillip Lougher <phillip@lougher.org.uk>
-+ *
-+ * 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,
-+ * 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, 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
-+ *
-+ * squashfs.h
-+ */
-+
-+#ifdef CONFIG_SQUASHFS_1_0_COMPATIBILITY
-+#undef CONFIG_SQUASHFS_1_0_COMPATIBILITY
-+#endif
-+
-+#ifdef SQUASHFS_TRACE
-+#define TRACE(s, args...)      printk(KERN_NOTICE "SQUASHFS: "s, ## args)
-+#else
-+#define TRACE(s, args...)      {}
-+#endif
-+
-+#define ERROR(s, args...)      printk(KERN_ERR "SQUASHFS error: "s, ## args)
-+
-+#define SERROR(s, args...)     do { \
-+                               if (!silent) \
-+                               printk(KERN_ERR "SQUASHFS error: "s, ## args);\
-+                               } while(0)
-+
-+#define WARNING(s, args...)    printk(KERN_WARNING "SQUASHFS: "s, ## args)
-+
-+static inline struct squashfs_inode_info *SQUASHFS_I(struct inode *inode)
-+{
-+       return list_entry(inode, struct squashfs_inode_info, vfs_inode);
-+}
-+
-+#if defined(CONFIG_SQUASHFS_1_0_COMPATIBILITY ) || defined(CONFIG_SQUASHFS_2_0_COMPATIBILITY)
-+#define SQSH_EXTERN
-+extern unsigned int squashfs_read_data(struct super_block *s, char *buffer,
-+                               long long index, unsigned int length,
-+                               long long *next_index);
-+extern int squashfs_get_cached_block(struct super_block *s, char *buffer,
-+                               long long block, unsigned int offset,
-+                               int length, long long *next_block,
-+                               unsigned int *next_offset);
-+extern void release_cached_fragment(struct squashfs_sb_info *msblk, struct
-+                                       squashfs_fragment_cache *fragment);
-+extern struct squashfs_fragment_cache *get_cached_fragment(struct super_block
-+                                       *s, long long start_block,
-+                                       int length);
-+extern struct address_space_operations squashfs_symlink_aops;
-+extern struct address_space_operations squashfs_aops;
-+extern struct address_space_operations squashfs_aops_4K;
-+extern struct inode_operations squashfs_dir_inode_ops;
-+#else
-+#define SQSH_EXTERN static
-+#endif
-+
-+#ifdef CONFIG_SQUASHFS_1_0_COMPATIBILITY
-+extern int squashfs_1_0_supported(struct squashfs_sb_info *msblk);
-+#else
-+static inline int squashfs_1_0_supported(struct squashfs_sb_info *msblk)
-+{
-+       return 0;
-+}
-+#endif
-+
-+#ifdef CONFIG_SQUASHFS_2_0_COMPATIBILITY
-+extern int squashfs_2_0_supported(struct squashfs_sb_info *msblk);
-+#else
-+static inline int squashfs_2_0_supported(struct squashfs_sb_info *msblk)
-+{
-+       return 0;
-+}
-+#endif
-Index: linux-2.6.22/include/linux/squashfs_fs.h
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/include/linux/squashfs_fs.h    2007-08-28 21:56:34.000000000 +0100
-@@ -0,0 +1,911 @@
-+#ifndef SQUASHFS_FS
-+#define SQUASHFS_FS
-+
-+/*
-+ * Squashfs
-+ *
-+ * Copyright (c) 2002, 2003, 2004, 2005, 2006
-+ * Phillip Lougher <phillip@lougher.org.uk>
-+ *
-+ * 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,
-+ * 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, 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
-+ *
-+ * squashfs_fs.h
-+ */
-+
-+#ifndef CONFIG_SQUASHFS_2_0_COMPATIBILITY
-+#define CONFIG_SQUASHFS_2_0_COMPATIBILITY
-+#endif
-+
-+#ifdef CONFIG_SQUASHFS_VMALLOC
-+#define SQUASHFS_ALLOC(a)              vmalloc(a)
-+#define SQUASHFS_FREE(a)               vfree(a)
-+#else
-+#define SQUASHFS_ALLOC(a)              kmalloc(a, GFP_KERNEL)
-+#define SQUASHFS_FREE(a)               kfree(a)
-+#endif
-+#define SQUASHFS_CACHED_FRAGMENTS      CONFIG_SQUASHFS_FRAGMENT_CACHE_SIZE     
-+#define SQUASHFS_MAJOR                 3
-+#define SQUASHFS_MINOR                 0
-+#define SQUASHFS_MAGIC                 0x73717368
-+#define SQUASHFS_MAGIC_SWAP            0x68737173
-+#define SQUASHFS_START                 0
-+
-+/* size of metadata (inode and directory) blocks */
-+#define SQUASHFS_METADATA_SIZE         8192
-+#define SQUASHFS_METADATA_LOG          13
-+
-+/* default size of data blocks */
-+#define SQUASHFS_FILE_SIZE             65536
-+#define SQUASHFS_FILE_LOG              16
-+
-+#define SQUASHFS_FILE_MAX_SIZE         65536
-+
-+/* Max number of uids and gids */
-+#define SQUASHFS_UIDS                  256
-+#define SQUASHFS_GUIDS                 255
-+
-+/* Max length of filename (not 255) */
-+#define SQUASHFS_NAME_LEN              256
-+
-+#define SQUASHFS_INVALID               ((long long) 0xffffffffffff)
-+#define SQUASHFS_INVALID_FRAG          ((unsigned int) 0xffffffff)
-+#define SQUASHFS_INVALID_BLK           ((long long) -1)
-+#define SQUASHFS_USED_BLK              ((long long) -2)
-+
-+/* Filesystem flags */
-+#define SQUASHFS_NOI                   0
-+#define SQUASHFS_NOD                   1
-+#define SQUASHFS_CHECK                 2
-+#define SQUASHFS_NOF                   3
-+#define SQUASHFS_NO_FRAG               4
-+#define SQUASHFS_ALWAYS_FRAG           5
-+#define SQUASHFS_DUPLICATE             6
-+
-+#define SQUASHFS_BIT(flag, bit)                ((flag >> bit) & 1)
-+
-+#define SQUASHFS_UNCOMPRESSED_INODES(flags)    SQUASHFS_BIT(flags, \
-+                                               SQUASHFS_NOI)
-+
-+#define SQUASHFS_UNCOMPRESSED_DATA(flags)      SQUASHFS_BIT(flags, \
-+                                               SQUASHFS_NOD)
-+
-+#define SQUASHFS_UNCOMPRESSED_FRAGMENTS(flags) SQUASHFS_BIT(flags, \
-+                                               SQUASHFS_NOF)
-+
-+#define SQUASHFS_NO_FRAGMENTS(flags)           SQUASHFS_BIT(flags, \
-+                                               SQUASHFS_NO_FRAG)
-+
-+#define SQUASHFS_ALWAYS_FRAGMENTS(flags)       SQUASHFS_BIT(flags, \
-+                                               SQUASHFS_ALWAYS_FRAG)
-+
-+#define SQUASHFS_DUPLICATES(flags)             SQUASHFS_BIT(flags, \
-+                                               SQUASHFS_DUPLICATE)
-+
-+#define SQUASHFS_CHECK_DATA(flags)             SQUASHFS_BIT(flags, \
-+                                               SQUASHFS_CHECK)
-+
-+#define SQUASHFS_MKFLAGS(noi, nod, check_data, nof, no_frag, always_frag, \
-+               duplicate_checking)     (noi | (nod << 1) | (check_data << 2) \
-+               | (nof << 3) | (no_frag << 4) | (always_frag << 5) | \
-+               (duplicate_checking << 6))
-+
-+/* Max number of types and file types */
-+#define SQUASHFS_DIR_TYPE              1
-+#define SQUASHFS_FILE_TYPE             2
-+#define SQUASHFS_SYMLINK_TYPE          3
-+#define SQUASHFS_BLKDEV_TYPE           4
-+#define SQUASHFS_CHRDEV_TYPE           5
-+#define SQUASHFS_FIFO_TYPE             6
-+#define SQUASHFS_SOCKET_TYPE           7
-+#define SQUASHFS_LDIR_TYPE             8
-+#define SQUASHFS_LREG_TYPE             9
-+
-+/* 1.0 filesystem type definitions */
-+#define SQUASHFS_TYPES                 5
-+#define SQUASHFS_IPC_TYPE              0
-+
-+/* Flag whether block is compressed or uncompressed, bit is set if block is
-+ * uncompressed */
-+#define SQUASHFS_COMPRESSED_BIT                (1 << 15)
-+
-+#define SQUASHFS_COMPRESSED_SIZE(B)    (((B) & ~SQUASHFS_COMPRESSED_BIT) ? \
-+               (B) & ~SQUASHFS_COMPRESSED_BIT :  SQUASHFS_COMPRESSED_BIT)
-+
-+#define SQUASHFS_COMPRESSED(B)         (!((B) & SQUASHFS_COMPRESSED_BIT))
-+
-+#define SQUASHFS_COMPRESSED_BIT_BLOCK          (1 << 24)
-+
-+#define SQUASHFS_COMPRESSED_SIZE_BLOCK(B)      (((B) & \
-+       ~SQUASHFS_COMPRESSED_BIT_BLOCK) ? (B) & \
-+       ~SQUASHFS_COMPRESSED_BIT_BLOCK : SQUASHFS_COMPRESSED_BIT_BLOCK)
-+
-+#define SQUASHFS_COMPRESSED_BLOCK(B)   (!((B) & SQUASHFS_COMPRESSED_BIT_BLOCK))
-+
-+/*
-+ * Inode number ops.  Inodes consist of a compressed block number, and an
-+ * uncompressed  offset within that block
-+ */
-+#define SQUASHFS_INODE_BLK(a)          ((unsigned int) ((a) >> 16))
-+
-+#define SQUASHFS_INODE_OFFSET(a)       ((unsigned int) ((a) & 0xffff))
-+
-+#define SQUASHFS_MKINODE(A, B)         ((squashfs_inode_t)(((squashfs_inode_t) (A)\
-+                                       << 16) + (B)))
-+
-+/* Compute 32 bit VFS inode number from squashfs inode number */
-+#define SQUASHFS_MK_VFS_INODE(a, b)    ((unsigned int) (((a) << 8) + \
-+                                       ((b) >> 2) + 1))
-+/* XXX */
-+
-+/* Translate between VFS mode and squashfs mode */
-+#define SQUASHFS_MODE(a)               ((a) & 0xfff)
-+
-+/* fragment and fragment table defines */
-+#define SQUASHFS_FRAGMENT_BYTES(A)     (A * sizeof(struct squashfs_fragment_entry))
-+
-+#define SQUASHFS_FRAGMENT_INDEX(A)     (SQUASHFS_FRAGMENT_BYTES(A) / \
-+                                       SQUASHFS_METADATA_SIZE)
-+
-+#define SQUASHFS_FRAGMENT_INDEX_OFFSET(A)      (SQUASHFS_FRAGMENT_BYTES(A) % \
-+                                               SQUASHFS_METADATA_SIZE)
-+
-+#define SQUASHFS_FRAGMENT_INDEXES(A)   ((SQUASHFS_FRAGMENT_BYTES(A) + \
-+                                       SQUASHFS_METADATA_SIZE - 1) / \
-+                                       SQUASHFS_METADATA_SIZE)
-+
-+#define SQUASHFS_FRAGMENT_INDEX_BYTES(A)       (SQUASHFS_FRAGMENT_INDEXES(A) *\
-+                                               sizeof(long long))
-+
-+/* cached data constants for filesystem */
-+#define SQUASHFS_CACHED_BLKS           8
-+
-+#define SQUASHFS_MAX_FILE_SIZE_LOG     64
-+
-+#define SQUASHFS_MAX_FILE_SIZE         ((long long) 1 << \
-+                                       (SQUASHFS_MAX_FILE_SIZE_LOG - 2))
-+
-+#define SQUASHFS_MARKER_BYTE           0xff
-+
-+/* meta index cache */
-+#define SQUASHFS_META_INDEXES  (SQUASHFS_METADATA_SIZE / sizeof(unsigned int))
-+#define SQUASHFS_META_ENTRIES  31
-+#define SQUASHFS_META_NUMBER   8
-+#define SQUASHFS_SLOTS         4
-+
-+struct meta_entry {
-+       long long               data_block;
-+       unsigned int            index_block;
-+       unsigned short          offset;
-+       unsigned short          pad;
-+};
-+
-+struct meta_index {
-+       unsigned int            inode_number;
-+       unsigned int            offset;
-+       unsigned short          entries;
-+       unsigned short          skip;
-+       unsigned short          locked;
-+       unsigned short          pad;
-+       struct meta_entry       meta_entry[SQUASHFS_META_ENTRIES];
-+};
-+
-+
-+/*
-+ * definitions for structures on disk
-+ */
-+
-+typedef long long              squashfs_block_t;
-+typedef long long              squashfs_inode_t;
-+
-+struct squashfs_super_block {
-+       unsigned int            s_magic;
-+       unsigned int            inodes;
-+       unsigned int            bytes_used_2;
-+       unsigned int            uid_start_2;
-+       unsigned int            guid_start_2;
-+       unsigned int            inode_table_start_2;
-+       unsigned int            directory_table_start_2;
-+       unsigned int            s_major:16;
-+       unsigned int            s_minor:16;
-+       unsigned int            block_size_1:16;
-+       unsigned int            block_log:16;
-+       unsigned int            flags:8;
-+       unsigned int            no_uids:8;
-+       unsigned int            no_guids:8;
-+       unsigned int            mkfs_time /* time of filesystem creation */;
-+       squashfs_inode_t        root_inode;
-+       unsigned int            block_size;
-+       unsigned int            fragments;
-+       unsigned int            fragment_table_start_2;
-+       long long               bytes_used;
-+       long long               uid_start;
-+       long long               guid_start;
-+       long long               inode_table_start;
-+       long long               directory_table_start;
-+       long long               fragment_table_start;
-+       long long               unused;
-+} __attribute__ ((packed));
-+
-+struct squashfs_dir_index {
-+       unsigned int            index;
-+       unsigned int            start_block;
-+       unsigned char           size;
-+       unsigned char           name[0];
-+} __attribute__ ((packed));
-+
-+#define SQUASHFS_BASE_INODE_HEADER             \
-+       unsigned int            inode_type:4;   \
-+       unsigned int            mode:12;        \
-+       unsigned int            uid:8;          \
-+       unsigned int            guid:8;         \
-+       unsigned int            mtime;          \
-+       unsigned int            inode_number;
-+
-+struct squashfs_base_inode_header {
-+       SQUASHFS_BASE_INODE_HEADER;
-+} __attribute__ ((packed));
-+
-+struct squashfs_ipc_inode_header {
-+       SQUASHFS_BASE_INODE_HEADER;
-+       unsigned int            nlink;
-+} __attribute__ ((packed));
-+
-+struct squashfs_dev_inode_header {
-+       SQUASHFS_BASE_INODE_HEADER;
-+       unsigned int            nlink;
-+       unsigned short          rdev;
-+} __attribute__ ((packed));
-+       
-+struct squashfs_symlink_inode_header {
-+       SQUASHFS_BASE_INODE_HEADER;
-+       unsigned int            nlink;
-+       unsigned short          symlink_size;
-+       char                    symlink[0];
-+} __attribute__ ((packed));
-+
-+struct squashfs_reg_inode_header {
-+       SQUASHFS_BASE_INODE_HEADER;
-+       squashfs_block_t        start_block;
-+       unsigned int            fragment;
-+       unsigned int            offset;
-+       unsigned int            file_size;
-+       unsigned short          block_list[0];
-+} __attribute__ ((packed));
-+
-+struct squashfs_lreg_inode_header {
-+       SQUASHFS_BASE_INODE_HEADER;
-+       unsigned int            nlink;
-+       squashfs_block_t        start_block;
-+       unsigned int            fragment;
-+       unsigned int            offset;
-+       long long               file_size;
-+       unsigned short          block_list[0];
-+} __attribute__ ((packed));
-+
-+struct squashfs_dir_inode_header {
-+       SQUASHFS_BASE_INODE_HEADER;
-+       unsigned int            nlink;
-+       unsigned int            file_size:19;
-+       unsigned int            offset:13;
-+       unsigned int            start_block;
-+       unsigned int            parent_inode;
-+} __attribute__  ((packed));
-+
-+struct squashfs_ldir_inode_header {
-+       SQUASHFS_BASE_INODE_HEADER;
-+       unsigned int            nlink;
-+       unsigned int            file_size:27;
-+       unsigned int            offset:13;
-+       unsigned int            start_block;
-+       unsigned int            i_count:16;
-+       unsigned int            parent_inode;
-+       struct squashfs_dir_index       index[0];
-+} __attribute__  ((packed));
-+
-+union squashfs_inode_header {
-+       struct squashfs_base_inode_header       base;
-+       struct squashfs_dev_inode_header        dev;
-+       struct squashfs_symlink_inode_header    symlink;
-+       struct squashfs_reg_inode_header        reg;
-+       struct squashfs_lreg_inode_header       lreg;
-+       struct squashfs_dir_inode_header        dir;
-+       struct squashfs_ldir_inode_header       ldir;
-+       struct squashfs_ipc_inode_header        ipc;
-+};
-+       
-+struct squashfs_dir_entry {
-+       unsigned int            offset:13;
-+       unsigned int            type:3;
-+       unsigned int            size:8;
-+       int                     inode_number:16;
-+       char                    name[0];
-+} __attribute__ ((packed));
-+
-+struct squashfs_dir_header {
-+       unsigned int            count:8;
-+       unsigned int            start_block;
-+       unsigned int            inode_number;
-+} __attribute__ ((packed));
-+
-+struct squashfs_fragment_entry {
-+       long long               start_block;
-+       unsigned int            size;
-+       unsigned int            unused;
-+} __attribute__ ((packed));
-+
-+extern int squashfs_uncompress_block(void *d, int dstlen, void *s, int srclen);
-+extern int squashfs_uncompress_init(void);
-+extern int squashfs_uncompress_exit(void);
-+
-+/*
-+ * macros to convert each packed bitfield structure from little endian to big
-+ * endian and vice versa.  These are needed when creating or using a filesystem
-+ * on a machine with different byte ordering to the target architecture.
-+ *
-+ */
-+
-+#define SQUASHFS_SWAP_START \
-+       int bits;\
-+       int b_pos;\
-+       unsigned long long val;\
-+       unsigned char *s;\
-+       unsigned char *d;
-+
-+#define SQUASHFS_SWAP_SUPER_BLOCK(s, d) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_MEMSET(s, d, sizeof(struct squashfs_super_block));\
-+       SQUASHFS_SWAP((s)->s_magic, d, 0, 32);\
-+       SQUASHFS_SWAP((s)->inodes, d, 32, 32);\
-+       SQUASHFS_SWAP((s)->bytes_used_2, d, 64, 32);\
-+       SQUASHFS_SWAP((s)->uid_start_2, d, 96, 32);\
-+       SQUASHFS_SWAP((s)->guid_start_2, d, 128, 32);\
-+       SQUASHFS_SWAP((s)->inode_table_start_2, d, 160, 32);\
-+       SQUASHFS_SWAP((s)->directory_table_start_2, d, 192, 32);\
-+       SQUASHFS_SWAP((s)->s_major, d, 224, 16);\
-+       SQUASHFS_SWAP((s)->s_minor, d, 240, 16);\
-+       SQUASHFS_SWAP((s)->block_size_1, d, 256, 16);\
-+       SQUASHFS_SWAP((s)->block_log, d, 272, 16);\
-+       SQUASHFS_SWAP((s)->flags, d, 288, 8);\
-+       SQUASHFS_SWAP((s)->no_uids, d, 296, 8);\
-+       SQUASHFS_SWAP((s)->no_guids, d, 304, 8);\
-+       SQUASHFS_SWAP((s)->mkfs_time, d, 312, 32);\
-+       SQUASHFS_SWAP((s)->root_inode, d, 344, 64);\
-+       SQUASHFS_SWAP((s)->block_size, d, 408, 32);\
-+       SQUASHFS_SWAP((s)->fragments, d, 440, 32);\
-+       SQUASHFS_SWAP((s)->fragment_table_start_2, d, 472, 32);\
-+       SQUASHFS_SWAP((s)->bytes_used, d, 504, 64);\
-+       SQUASHFS_SWAP((s)->uid_start, d, 568, 64);\
-+       SQUASHFS_SWAP((s)->guid_start, d, 632, 64);\
-+       SQUASHFS_SWAP((s)->inode_table_start, d, 696, 64);\
-+       SQUASHFS_SWAP((s)->directory_table_start, d, 760, 64);\
-+       SQUASHFS_SWAP((s)->fragment_table_start, d, 824, 64);\
-+       SQUASHFS_SWAP((s)->unused, d, 888, 64);\
-+}
-+
-+#define SQUASHFS_SWAP_BASE_INODE_CORE(s, d, n)\
-+       SQUASHFS_MEMSET(s, d, n);\
-+       SQUASHFS_SWAP((s)->inode_type, d, 0, 4);\
-+       SQUASHFS_SWAP((s)->mode, d, 4, 12);\
-+       SQUASHFS_SWAP((s)->uid, d, 16, 8);\
-+       SQUASHFS_SWAP((s)->guid, d, 24, 8);\
-+       SQUASHFS_SWAP((s)->mtime, d, 32, 32);\
-+       SQUASHFS_SWAP((s)->inode_number, d, 64, 32);
-+
-+#define SQUASHFS_SWAP_BASE_INODE_HEADER(s, d, n) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_SWAP_BASE_INODE_CORE(s, d, n)\
-+}
-+
-+#define SQUASHFS_SWAP_IPC_INODE_HEADER(s, d) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_SWAP_BASE_INODE_CORE(s, d, \
-+                       sizeof(struct squashfs_ipc_inode_header))\
-+       SQUASHFS_SWAP((s)->nlink, d, 96, 32);\
-+}
-+
-+#define SQUASHFS_SWAP_DEV_INODE_HEADER(s, d) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_SWAP_BASE_INODE_CORE(s, d, \
-+                       sizeof(struct squashfs_dev_inode_header)); \
-+       SQUASHFS_SWAP((s)->nlink, d, 96, 32);\
-+       SQUASHFS_SWAP((s)->rdev, d, 128, 16);\
-+}
-+
-+#define SQUASHFS_SWAP_SYMLINK_INODE_HEADER(s, d) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_SWAP_BASE_INODE_CORE(s, d, \
-+                       sizeof(struct squashfs_symlink_inode_header));\
-+       SQUASHFS_SWAP((s)->nlink, d, 96, 32);\
-+       SQUASHFS_SWAP((s)->symlink_size, d, 128, 16);\
-+}
-+
-+#define SQUASHFS_SWAP_REG_INODE_HEADER(s, d) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_SWAP_BASE_INODE_CORE(s, d, \
-+                       sizeof(struct squashfs_reg_inode_header));\
-+       SQUASHFS_SWAP((s)->start_block, d, 96, 64);\
-+       SQUASHFS_SWAP((s)->fragment, d, 160, 32);\
-+       SQUASHFS_SWAP((s)->offset, d, 192, 32);\
-+       SQUASHFS_SWAP((s)->file_size, d, 224, 32);\
-+}
-+
-+#define SQUASHFS_SWAP_LREG_INODE_HEADER(s, d) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_SWAP_BASE_INODE_CORE(s, d, \
-+                       sizeof(struct squashfs_lreg_inode_header));\
-+       SQUASHFS_SWAP((s)->nlink, d, 96, 32);\
-+       SQUASHFS_SWAP((s)->start_block, d, 128, 64);\
-+       SQUASHFS_SWAP((s)->fragment, d, 192, 32);\
-+       SQUASHFS_SWAP((s)->offset, d, 224, 32);\
-+       SQUASHFS_SWAP((s)->file_size, d, 256, 64);\
-+}
-+
-+#define SQUASHFS_SWAP_DIR_INODE_HEADER(s, d) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_SWAP_BASE_INODE_CORE(s, d, \
-+                       sizeof(struct squashfs_dir_inode_header));\
-+       SQUASHFS_SWAP((s)->nlink, d, 96, 32);\
-+       SQUASHFS_SWAP((s)->file_size, d, 128, 19);\
-+       SQUASHFS_SWAP((s)->offset, d, 147, 13);\
-+       SQUASHFS_SWAP((s)->start_block, d, 160, 32);\
-+       SQUASHFS_SWAP((s)->parent_inode, d, 192, 32);\
-+}
-+
-+#define SQUASHFS_SWAP_LDIR_INODE_HEADER(s, d) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_SWAP_BASE_INODE_CORE(s, d, \
-+                       sizeof(struct squashfs_ldir_inode_header));\
-+       SQUASHFS_SWAP((s)->nlink, d, 96, 32);\
-+       SQUASHFS_SWAP((s)->file_size, d, 128, 27);\
-+       SQUASHFS_SWAP((s)->offset, d, 155, 13);\
-+       SQUASHFS_SWAP((s)->start_block, d, 168, 32);\
-+       SQUASHFS_SWAP((s)->i_count, d, 200, 16);\
-+       SQUASHFS_SWAP((s)->parent_inode, d, 216, 32);\
-+}
-+
-+#define SQUASHFS_SWAP_DIR_INDEX(s, d) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_MEMSET(s, d, sizeof(struct squashfs_dir_index));\
-+       SQUASHFS_SWAP((s)->index, d, 0, 32);\
-+       SQUASHFS_SWAP((s)->start_block, d, 32, 32);\
-+       SQUASHFS_SWAP((s)->size, d, 64, 8);\
-+}
-+
-+#define SQUASHFS_SWAP_DIR_HEADER(s, d) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_MEMSET(s, d, sizeof(struct squashfs_dir_header));\
-+       SQUASHFS_SWAP((s)->count, d, 0, 8);\
-+       SQUASHFS_SWAP((s)->start_block, d, 8, 32);\
-+       SQUASHFS_SWAP((s)->inode_number, d, 40, 32);\
-+}
-+
-+#define SQUASHFS_SWAP_DIR_ENTRY(s, d) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_MEMSET(s, d, sizeof(struct squashfs_dir_entry));\
-+       SQUASHFS_SWAP((s)->offset, d, 0, 13);\
-+       SQUASHFS_SWAP((s)->type, d, 13, 3);\
-+       SQUASHFS_SWAP((s)->size, d, 16, 8);\
-+       SQUASHFS_SWAP((s)->inode_number, d, 24, 16);\
-+}
-+
-+#define SQUASHFS_SWAP_FRAGMENT_ENTRY(s, d) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_MEMSET(s, d, sizeof(struct squashfs_fragment_entry));\
-+       SQUASHFS_SWAP((s)->start_block, d, 0, 64);\
-+       SQUASHFS_SWAP((s)->size, d, 64, 32);\
-+}
-+
-+#define SQUASHFS_SWAP_SHORTS(s, d, n) {\
-+       int entry;\
-+       int bit_position;\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_MEMSET(s, d, n * 2);\
-+       for(entry = 0, bit_position = 0; entry < n; entry++, bit_position += \
-+                       16)\
-+               SQUASHFS_SWAP(s[entry], d, bit_position, 16);\
-+}
-+
-+#define SQUASHFS_SWAP_INTS(s, d, n) {\
-+       int entry;\
-+       int bit_position;\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_MEMSET(s, d, n * 4);\
-+       for(entry = 0, bit_position = 0; entry < n; entry++, bit_position += \
-+                       32)\
-+               SQUASHFS_SWAP(s[entry], d, bit_position, 32);\
-+}
-+
-+#define SQUASHFS_SWAP_LONG_LONGS(s, d, n) {\
-+       int entry;\
-+       int bit_position;\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_MEMSET(s, d, n * 8);\
-+       for(entry = 0, bit_position = 0; entry < n; entry++, bit_position += \
-+                       64)\
-+               SQUASHFS_SWAP(s[entry], d, bit_position, 64);\
-+}
-+
-+#define SQUASHFS_SWAP_DATA(s, d, n, bits) {\
-+       int entry;\
-+       int bit_position;\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_MEMSET(s, d, n * bits / 8);\
-+       for(entry = 0, bit_position = 0; entry < n; entry++, bit_position += \
-+                       bits)\
-+               SQUASHFS_SWAP(s[entry], d, bit_position, bits);\
-+}
-+
-+#define SQUASHFS_SWAP_FRAGMENT_INDEXES(s, d, n) SQUASHFS_SWAP_LONG_LONGS(s, d, n)
-+
-+#ifdef CONFIG_SQUASHFS_1_0_COMPATIBILITY
-+
-+struct squashfs_base_inode_header_1 {
-+       unsigned int            inode_type:4;
-+       unsigned int            mode:12; /* protection */
-+       unsigned int            uid:4; /* index into uid table */
-+       unsigned int            guid:4; /* index into guid table */
-+} __attribute__ ((packed));
-+
-+struct squashfs_ipc_inode_header_1 {
-+       unsigned int            inode_type:4;
-+       unsigned int            mode:12; /* protection */
-+       unsigned int            uid:4; /* index into uid table */
-+       unsigned int            guid:4; /* index into guid table */
-+       unsigned int            type:4;
-+       unsigned int            offset:4;
-+} __attribute__ ((packed));
-+
-+struct squashfs_dev_inode_header_1 {
-+       unsigned int            inode_type:4;
-+       unsigned int            mode:12; /* protection */
-+       unsigned int            uid:4; /* index into uid table */
-+       unsigned int            guid:4; /* index into guid table */
-+       unsigned short          rdev;
-+} __attribute__ ((packed));
-+       
-+struct squashfs_symlink_inode_header_1 {
-+       unsigned int            inode_type:4;
-+       unsigned int            mode:12; /* protection */
-+       unsigned int            uid:4; /* index into uid table */
-+       unsigned int            guid:4; /* index into guid table */
-+       unsigned short          symlink_size;
-+       char                    symlink[0];
-+} __attribute__ ((packed));
-+
-+struct squashfs_reg_inode_header_1 {
-+       unsigned int            inode_type:4;
-+       unsigned int            mode:12; /* protection */
-+       unsigned int            uid:4; /* index into uid table */
-+       unsigned int            guid:4; /* index into guid table */
-+       unsigned int            mtime;
-+       unsigned int            start_block;
-+       unsigned int            file_size:32;
-+       unsigned short          block_list[0];
-+} __attribute__ ((packed));
-+
-+struct squashfs_dir_inode_header_1 {
-+       unsigned int            inode_type:4;
-+       unsigned int            mode:12; /* protection */
-+       unsigned int            uid:4; /* index into uid table */
-+       unsigned int            guid:4; /* index into guid table */
-+       unsigned int            file_size:19;
-+       unsigned int            offset:13;
-+       unsigned int            mtime;
-+       unsigned int            start_block:24;
-+} __attribute__  ((packed));
-+
-+#define SQUASHFS_SWAP_BASE_INODE_CORE_1(s, d, n) \
-+       SQUASHFS_MEMSET(s, d, n);\
-+       SQUASHFS_SWAP((s)->inode_type, d, 0, 4);\
-+       SQUASHFS_SWAP((s)->mode, d, 4, 12);\
-+       SQUASHFS_SWAP((s)->uid, d, 16, 4);\
-+       SQUASHFS_SWAP((s)->guid, d, 20, 4);
-+
-+#define SQUASHFS_SWAP_BASE_INODE_HEADER_1(s, d, n) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_SWAP_BASE_INODE_CORE_1(s, d, n)\
-+}
-+
-+#define SQUASHFS_SWAP_IPC_INODE_HEADER_1(s, d) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_SWAP_BASE_INODE_CORE_1(s, d, \
-+                       sizeof(struct squashfs_ipc_inode_header_1));\
-+       SQUASHFS_SWAP((s)->type, d, 24, 4);\
-+       SQUASHFS_SWAP((s)->offset, d, 28, 4);\
-+}
-+
-+#define SQUASHFS_SWAP_DEV_INODE_HEADER_1(s, d) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_SWAP_BASE_INODE_CORE_1(s, d, \
-+                       sizeof(struct squashfs_dev_inode_header_1));\
-+       SQUASHFS_SWAP((s)->rdev, d, 24, 16);\
-+}
-+
-+#define SQUASHFS_SWAP_SYMLINK_INODE_HEADER_1(s, d) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_SWAP_BASE_INODE_CORE_1(s, d, \
-+                       sizeof(struct squashfs_symlink_inode_header_1));\
-+       SQUASHFS_SWAP((s)->symlink_size, d, 24, 16);\
-+}
-+
-+#define SQUASHFS_SWAP_REG_INODE_HEADER_1(s, d) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_SWAP_BASE_INODE_CORE_1(s, d, \
-+                       sizeof(struct squashfs_reg_inode_header_1));\
-+       SQUASHFS_SWAP((s)->mtime, d, 24, 32);\
-+       SQUASHFS_SWAP((s)->start_block, d, 56, 32);\
-+       SQUASHFS_SWAP((s)->file_size, d, 88, 32);\
-+}
-+
-+#define SQUASHFS_SWAP_DIR_INODE_HEADER_1(s, d) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_SWAP_BASE_INODE_CORE_1(s, d, \
-+                       sizeof(struct squashfs_dir_inode_header_1));\
-+       SQUASHFS_SWAP((s)->file_size, d, 24, 19);\
-+       SQUASHFS_SWAP((s)->offset, d, 43, 13);\
-+       SQUASHFS_SWAP((s)->mtime, d, 56, 32);\
-+       SQUASHFS_SWAP((s)->start_block, d, 88, 24);\
-+}
-+
-+#endif
-+
-+#ifdef CONFIG_SQUASHFS_2_0_COMPATIBILITY
-+
-+struct squashfs_dir_index_2 {
-+       unsigned int            index:27;
-+       unsigned int            start_block:29;
-+       unsigned char           size;
-+       unsigned char           name[0];
-+} __attribute__ ((packed));
-+
-+struct squashfs_base_inode_header_2 {
-+       unsigned int            inode_type:4;
-+       unsigned int            mode:12; /* protection */
-+       unsigned int            uid:8; /* index into uid table */
-+       unsigned int            guid:8; /* index into guid table */
-+} __attribute__ ((packed));
-+
-+struct squashfs_ipc_inode_header_2 {
-+       unsigned int            inode_type:4;
-+       unsigned int            mode:12; /* protection */
-+       unsigned int            uid:8; /* index into uid table */
-+       unsigned int            guid:8; /* index into guid table */
-+} __attribute__ ((packed));
-+
-+struct squashfs_dev_inode_header_2 {
-+       unsigned int            inode_type:4;
-+       unsigned int            mode:12; /* protection */
-+       unsigned int            uid:8; /* index into uid table */
-+       unsigned int            guid:8; /* index into guid table */
-+       unsigned short          rdev;
-+} __attribute__ ((packed));
-+       
-+struct squashfs_symlink_inode_header_2 {
-+       unsigned int            inode_type:4;
-+       unsigned int            mode:12; /* protection */
-+       unsigned int            uid:8; /* index into uid table */
-+       unsigned int            guid:8; /* index into guid table */
-+       unsigned short          symlink_size;
-+       char                    symlink[0];
-+} __attribute__ ((packed));
-+
-+struct squashfs_reg_inode_header_2 {
-+       unsigned int            inode_type:4;
-+       unsigned int            mode:12; /* protection */
-+       unsigned int            uid:8; /* index into uid table */
-+       unsigned int            guid:8; /* index into guid table */
-+       unsigned int            mtime;
-+       unsigned int            start_block;
-+       unsigned int            fragment;
-+       unsigned int            offset;
-+       unsigned int            file_size:32;
-+       unsigned short          block_list[0];
-+} __attribute__ ((packed));
-+
-+struct squashfs_dir_inode_header_2 {
-+       unsigned int            inode_type:4;
-+       unsigned int            mode:12; /* protection */
-+       unsigned int            uid:8; /* index into uid table */
-+       unsigned int            guid:8; /* index into guid table */
-+       unsigned int            file_size:19;
-+       unsigned int            offset:13;
-+       unsigned int            mtime;
-+       unsigned int            start_block:24;
-+} __attribute__  ((packed));
-+
-+struct squashfs_ldir_inode_header_2 {
-+       unsigned int            inode_type:4;
-+       unsigned int            mode:12; /* protection */
-+       unsigned int            uid:8; /* index into uid table */
-+       unsigned int            guid:8; /* index into guid table */
-+       unsigned int            file_size:27;
-+       unsigned int            offset:13;
-+       unsigned int            mtime;
-+       unsigned int            start_block:24;
-+       unsigned int            i_count:16;
-+       struct squashfs_dir_index_2     index[0];
-+} __attribute__  ((packed));
-+
-+union squashfs_inode_header_2 {
-+       struct squashfs_base_inode_header_2     base;
-+       struct squashfs_dev_inode_header_2      dev;
-+       struct squashfs_symlink_inode_header_2  symlink;
-+       struct squashfs_reg_inode_header_2      reg;
-+       struct squashfs_dir_inode_header_2      dir;
-+       struct squashfs_ldir_inode_header_2     ldir;
-+       struct squashfs_ipc_inode_header_2      ipc;
-+};
-+       
-+struct squashfs_dir_header_2 {
-+       unsigned int            count:8;
-+       unsigned int            start_block:24;
-+} __attribute__ ((packed));
-+
-+struct squashfs_dir_entry_2 {
-+       unsigned int            offset:13;
-+       unsigned int            type:3;
-+       unsigned int            size:8;
-+       char                    name[0];
-+} __attribute__ ((packed));
-+
-+struct squashfs_fragment_entry_2 {
-+       unsigned int            start_block;
-+       unsigned int            size;
-+} __attribute__ ((packed));
-+
-+#define SQUASHFS_SWAP_BASE_INODE_CORE_2(s, d, n)\
-+       SQUASHFS_MEMSET(s, d, n);\
-+       SQUASHFS_SWAP((s)->inode_type, d, 0, 4);\
-+       SQUASHFS_SWAP((s)->mode, d, 4, 12);\
-+       SQUASHFS_SWAP((s)->uid, d, 16, 8);\
-+       SQUASHFS_SWAP((s)->guid, d, 24, 8);\
-+
-+#define SQUASHFS_SWAP_BASE_INODE_HEADER_2(s, d, n) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_SWAP_BASE_INODE_CORE_2(s, d, n)\
-+}
-+
-+#define SQUASHFS_SWAP_IPC_INODE_HEADER_2(s, d) \
-+       SQUASHFS_SWAP_BASE_INODE_HEADER_2(s, d, sizeof(struct squashfs_ipc_inode_header_2))
-+
-+#define SQUASHFS_SWAP_DEV_INODE_HEADER_2(s, d) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_SWAP_BASE_INODE_CORE_2(s, d, \
-+                       sizeof(struct squashfs_dev_inode_header_2)); \
-+       SQUASHFS_SWAP((s)->rdev, d, 32, 16);\
-+}
-+
-+#define SQUASHFS_SWAP_SYMLINK_INODE_HEADER_2(s, d) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_SWAP_BASE_INODE_CORE_2(s, d, \
-+                       sizeof(struct squashfs_symlink_inode_header_2));\
-+       SQUASHFS_SWAP((s)->symlink_size, d, 32, 16);\
-+}
-+
-+#define SQUASHFS_SWAP_REG_INODE_HEADER_2(s, d) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_SWAP_BASE_INODE_CORE_2(s, d, \
-+                       sizeof(struct squashfs_reg_inode_header_2));\
-+       SQUASHFS_SWAP((s)->mtime, d, 32, 32);\
-+       SQUASHFS_SWAP((s)->start_block, d, 64, 32);\
-+       SQUASHFS_SWAP((s)->fragment, d, 96, 32);\
-+       SQUASHFS_SWAP((s)->offset, d, 128, 32);\
-+       SQUASHFS_SWAP((s)->file_size, d, 160, 32);\
-+}
-+
-+#define SQUASHFS_SWAP_DIR_INODE_HEADER_2(s, d) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_SWAP_BASE_INODE_CORE_2(s, d, \
-+                       sizeof(struct squashfs_dir_inode_header_2));\
-+       SQUASHFS_SWAP((s)->file_size, d, 32, 19);\
-+       SQUASHFS_SWAP((s)->offset, d, 51, 13);\
-+       SQUASHFS_SWAP((s)->mtime, d, 64, 32);\
-+       SQUASHFS_SWAP((s)->start_block, d, 96, 24);\
-+}
-+
-+#define SQUASHFS_SWAP_LDIR_INODE_HEADER_2(s, d) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_SWAP_BASE_INODE_CORE_2(s, d, \
-+                       sizeof(struct squashfs_ldir_inode_header_2));\
-+       SQUASHFS_SWAP((s)->file_size, d, 32, 27);\
-+       SQUASHFS_SWAP((s)->offset, d, 59, 13);\
-+       SQUASHFS_SWAP((s)->mtime, d, 72, 32);\
-+       SQUASHFS_SWAP((s)->start_block, d, 104, 24);\
-+       SQUASHFS_SWAP((s)->i_count, d, 128, 16);\
-+}
-+
-+#define SQUASHFS_SWAP_DIR_INDEX_2(s, d) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_MEMSET(s, d, sizeof(struct squashfs_dir_index_2));\
-+       SQUASHFS_SWAP((s)->index, d, 0, 27);\
-+       SQUASHFS_SWAP((s)->start_block, d, 27, 29);\
-+       SQUASHFS_SWAP((s)->size, d, 56, 8);\
-+}
-+#define SQUASHFS_SWAP_DIR_HEADER_2(s, d) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_MEMSET(s, d, sizeof(struct squashfs_dir_header_2));\
-+       SQUASHFS_SWAP((s)->count, d, 0, 8);\
-+       SQUASHFS_SWAP((s)->start_block, d, 8, 24);\
-+}
-+
-+#define SQUASHFS_SWAP_DIR_ENTRY_2(s, d) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_MEMSET(s, d, sizeof(struct squashfs_dir_entry_2));\
-+       SQUASHFS_SWAP((s)->offset, d, 0, 13);\
-+       SQUASHFS_SWAP((s)->type, d, 13, 3);\
-+       SQUASHFS_SWAP((s)->size, d, 16, 8);\
-+}
-+
-+#define SQUASHFS_SWAP_FRAGMENT_ENTRY_2(s, d) {\
-+       SQUASHFS_SWAP_START\
-+       SQUASHFS_MEMSET(s, d, sizeof(struct squashfs_fragment_entry_2));\
-+       SQUASHFS_SWAP((s)->start_block, d, 0, 32);\
-+       SQUASHFS_SWAP((s)->size, d, 32, 32);\
-+}
-+
-+#define SQUASHFS_SWAP_FRAGMENT_INDEXES_2(s, d, n) SQUASHFS_SWAP_INTS(s, d, n)
-+
-+/* fragment and fragment table defines */
-+#define SQUASHFS_FRAGMENT_BYTES_2(A)   (A * sizeof(struct squashfs_fragment_entry_2))
-+
-+#define SQUASHFS_FRAGMENT_INDEX_2(A)   (SQUASHFS_FRAGMENT_BYTES_2(A) / \
-+                                       SQUASHFS_METADATA_SIZE)
-+
-+#define SQUASHFS_FRAGMENT_INDEX_OFFSET_2(A)    (SQUASHFS_FRAGMENT_BYTES_2(A) % \
-+                                               SQUASHFS_METADATA_SIZE)
-+
-+#define SQUASHFS_FRAGMENT_INDEXES_2(A) ((SQUASHFS_FRAGMENT_BYTES_2(A) + \
-+                                       SQUASHFS_METADATA_SIZE - 1) / \
-+                                       SQUASHFS_METADATA_SIZE)
-+
-+#define SQUASHFS_FRAGMENT_INDEX_BYTES_2(A)     (SQUASHFS_FRAGMENT_INDEXES_2(A) *\
-+                                               sizeof(int))
-+
-+#endif
-+
-+#ifdef __KERNEL__
-+
-+/*
-+ * macros used to swap each structure entry, taking into account
-+ * bitfields and different bitfield placing conventions on differing
-+ * architectures
-+ */
-+
-+#include <asm/byteorder.h>
-+
-+#ifdef __BIG_ENDIAN
-+       /* convert from little endian to big endian */
-+#define SQUASHFS_SWAP(value, p, pos, tbits) _SQUASHFS_SWAP(value, p, pos, \
-+               tbits, b_pos)
-+#else
-+       /* convert from big endian to little endian */ 
-+#define SQUASHFS_SWAP(value, p, pos, tbits) _SQUASHFS_SWAP(value, p, pos, \
-+               tbits, 64 - tbits - b_pos)
-+#endif
-+
-+#define _SQUASHFS_SWAP(value, p, pos, tbits, SHIFT) {\
-+       b_pos = pos % 8;\
-+       val = 0;\
-+       s = (unsigned char *)p + (pos / 8);\
-+       d = ((unsigned char *) &val) + 7;\
-+       for(bits = 0; bits < (tbits + b_pos); bits += 8) \
-+               *d-- = *s++;\
-+       value = (val >> (SHIFT))/* & ((1 << tbits) - 1)*/;\
-+}
-+
-+#define SQUASHFS_MEMSET(s, d, n)       memset(s, 0, n);
-+
-+#endif
-+#endif
-Index: linux-2.6.22/include/linux/squashfs_fs_i.h
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/include/linux/squashfs_fs_i.h  2007-08-28 21:56:34.000000000 +0100
-@@ -0,0 +1,45 @@
-+#ifndef SQUASHFS_FS_I
-+#define SQUASHFS_FS_I
-+/*
-+ * Squashfs
-+ *
-+ * Copyright (c) 2002, 2003, 2004, 2005, 2006
-+ * Phillip Lougher <phillip@lougher.org.uk>
-+ *
-+ * 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,
-+ * 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, 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
-+ *
-+ * squashfs_fs_i.h
-+ */
-+
-+struct squashfs_inode_info {
-+       long long       start_block;
-+       unsigned int    offset;
-+       union {
-+               struct {
-+                       long long       fragment_start_block;
-+                       unsigned int    fragment_size;
-+                       unsigned int    fragment_offset;
-+                       long long       block_list_start;
-+               } s1;
-+               struct {
-+                       long long       directory_index_start;
-+                       unsigned int    directory_index_offset;
-+                       unsigned int    directory_index_count;
-+                       unsigned int    parent_inode;
-+               } s2;
-+       } u;
-+       struct inode    vfs_inode;
-+};
-+#endif
-Index: linux-2.6.22/include/linux/squashfs_fs_sb.h
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/include/linux/squashfs_fs_sb.h 2007-08-28 21:56:34.000000000 +0100
-@@ -0,0 +1,74 @@
-+#ifndef SQUASHFS_FS_SB
-+#define SQUASHFS_FS_SB
-+/*
-+ * Squashfs
-+ *
-+ * Copyright (c) 2002, 2003, 2004, 2005, 2006
-+ * Phillip Lougher <phillip@lougher.org.uk>
-+ *
-+ * 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,
-+ * 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, 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
-+ *
-+ * squashfs_fs_sb.h
-+ */
-+
-+#include <linux/squashfs_fs.h>
-+
-+struct squashfs_cache {
-+       long long       block;
-+       int             length;
-+       long long       next_index;
-+       char            *data;
-+};
-+
-+struct squashfs_fragment_cache {
-+       long long       block;
-+       int             length;
-+       unsigned int    locked;
-+       char            *data;
-+};
-+
-+struct squashfs_sb_info {
-+       struct squashfs_super_block     sblk;
-+       int                     devblksize;
-+       int                     devblksize_log2;
-+       int                     swap;
-+       struct squashfs_cache   *block_cache;
-+       struct squashfs_fragment_cache  *fragment;
-+       int                     next_cache;
-+       int                     next_fragment;
-+       int                     next_meta_index;
-+       unsigned int            *uid;
-+       unsigned int            *guid;
-+       long long               *fragment_index;
-+       unsigned int            *fragment_index_2;
-+       unsigned int            read_size;
-+       char                    *read_data;
-+       char                    *read_page;
-+       struct semaphore        read_data_mutex;
-+       struct semaphore        read_page_mutex;
-+       struct semaphore        block_cache_mutex;
-+       struct semaphore        fragment_mutex;
-+       struct semaphore        meta_index_mutex;
-+       wait_queue_head_t       waitq;
-+       wait_queue_head_t       fragment_wait_queue;
-+       struct meta_index       *meta_index;
-+       struct inode            *(*iget)(struct super_block *s,  squashfs_inode_t \
-+                               inode);
-+       long long               (*read_blocklist)(struct inode *inode, int \
-+                               index, int readahead_blks, char *block_list, \
-+                               unsigned short **block_p, unsigned int *bsize);
-+       int                     (*read_fragment_index_table)(struct super_block *s);
-+};
-+#endif
-Index: linux-2.6.22/init/do_mounts_rd.c
-===================================================================
---- linux-2.6.22.orig/init/do_mounts_rd.c       2007-08-28 21:54:14.000000000 +0100
-+++ linux-2.6.22/init/do_mounts_rd.c    2007-08-28 21:56:34.000000000 +0100
-@@ -5,6 +5,7 @@
- #include <linux/ext2_fs.h>
- #include <linux/romfs_fs.h>
- #include <linux/cramfs_fs.h>
-+#include <linux/squashfs_fs.h>
- #include <linux/initrd.h>
- #include <linux/string.h>
- 
-@@ -39,6 +40,7 @@ static int __init crd_load(int in_fd, in
-  * numbers could not be found.
-  *
-  * We currently check for the following magic numbers:
-+ *      squashfs
-  *     minix
-  *     ext2
-  *     romfs
-@@ -53,6 +55,7 @@ identify_ramdisk_image(int fd, int start
-        struct ext2_super_block *ext2sb;
-        struct romfs_super_block *romfsb;
-        struct cramfs_super *cramfsb;
-+       struct squashfs_super_block *squashfsb;
-        int nblocks = -1;
-        unsigned char *buf;
- 
-@@ -64,6 +67,7 @@ identify_ramdisk_image(int fd, int start
-        ext2sb = (struct ext2_super_block *) buf;
-        romfsb = (struct romfs_super_block *) buf;
-        cramfsb = (struct cramfs_super *) buf;
-+       squashfsb = (struct squashfs_super_block *) buf;
-        memset(buf, 0xe5, size);
- 
-        /*
-@@ -101,6 +105,15 @@ identify_ramdisk_image(int fd, int start
-                goto done;
-        }
- 
-+       /* squashfs is at block zero too */
-+       if (squashfsb->s_magic == SQUASHFS_MAGIC) {
-+               printk(KERN_NOTICE
-+                      "RAMDISK: squashfs filesystem found at block %d\n",
-+                      start_block);
-+               nblocks = (squashfsb->bytes_used+BLOCK_SIZE-1)>>BLOCK_SIZE_BITS;
-+               goto done;
-+       }
-+
-        /*
-         * Read block 1 to test for minix and ext2 superblock
-         */
diff --git a/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/squashfs3.2-2.6.20-r0.patch b/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/squashfs3.3.patch
index 3870b317e4..cb9a5c49e4 100644
--- a/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/squashfs3.2-2.6.20-r0.patch
+++ b/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/squashfs3.3.patch
@@ -1,25 +1,27 @@
---- linux-2.6.24-rc1.orig/fs/Kconfig
-+++ linux-2.6.24-rc1/fs/Kconfig
-@@ -1405,6 +1405,71 @@
+diff -x .gitignore -Nurp linux-2.6.24/fs/Kconfig linux-2.6.24-squashfs3.3/fs/Kconfig
+--- linux-2.6.24/fs/Kconfig     2007-10-25 17:41:45.000000000 +0100
++++ linux-2.6.24-squashfs3.3/fs/Kconfig 2007-11-01 05:06:25.000000000 +0000
+@@ -1396,6 +1396,56 @@ config CRAMFS
  
           If unsure, say N.
  
 +config SQUASHFS
-+       tristate "SquashFS 3.2 - Squashed file system support"
++       tristate "SquashFS 3.3 - Squashed file system support"
 +       select ZLIB_INFLATE
 +       help
-+         Saying Y here includes support for SquashFS 3.2 (a Compressed Read-Only File
-+         System).  Squashfs is a highly compressed read-only filesystem for Linux.
-+         It uses zlib compression to compress both files, inodes and directories.
-+         Inodes in the system are very small and all blocks are packed to minimise
-+         data overhead. Block sizes greater than 4K are supported up to a maximum of 64K.
-+         SquashFS 3.1 supports 64 bit filesystems and files (larger than 4GB), full
-+         uid/gid information, hard links and timestamps.
-+
-+         Squashfs is intended for general read-only filesystem use, for archival
-+         use (i.e. in cases where a .tar.gz file may be used), and in embedded
-+         systems where low overhead is needed.  Further information and filesystem tools
-+         are available from http://squashfs.sourceforge.net.
++         Saying Y here includes support for SquashFS 3.3 (a Compressed
++         Read-Only File System).  Squashfs is a highly compressed read-only
++         filesystem for Linux.  It uses zlib compression to compress both
++         files, inodes and directories.  Inodes in the system are very small
++         and all blocks are packed to minimise data overhead. Block sizes
++         greater than 4K are supported up to a maximum of 1 Mbytes (default
++         block size 128K).  SquashFS 3.3 supports 64 bit filesystems and files
++         (larger than 4GB), full uid/gid information, hard links and timestamps.  
++
++         Squashfs is intended for general read-only filesystem use, for
++         archival use (i.e. in cases where a .tar.gz file may be used), and in
++         embedded systems where low overhead is needed.  Further information
++         and filesystem tools are available from http://squashfs.sourceforge.net.
 +
 +         If you want to compile this as a module ( = code which can be
 +         inserted in and removed from the running kernel whenever you want),
@@ -31,13 +33,11 @@
 +
 +config SQUASHFS_EMBEDDED
 +
-+       bool "Additional options for memory-constrained systems" 
++       bool "Additional option for memory-constrained systems" 
 +       depends on SQUASHFS
 +       default n
 +       help
-+         Saying Y here allows you to specify cache sizes and how Squashfs
-+         allocates memory.  This is only intended for memory constrained
-+         systems.
++         Saying Y here allows you to specify cache size.
 +
 +         If unsure, say N.
 +
@@ -55,26 +55,13 @@
 +         Note there must be at least one cached fragment.  Anything
 +         much more than three will probably not make much difference.
 +
-+config SQUASHFS_VMALLOC
-+       bool "Use Vmalloc rather than Kmalloc" if SQUASHFS_EMBEDDED
-+       depends on SQUASHFS
-+       default n
-+       help
-+         By default SquashFS uses kmalloc to obtain fragment cache memory.
-+         Kmalloc memory is the standard kernel allocator, but it can fail
-+         on memory constrained systems.  Because of the way Vmalloc works,
-+         Vmalloc can succeed when kmalloc fails.  Specifying this option
-+         will make SquashFS always use Vmalloc to allocate the
-+         fragment cache memory.
-+
-+         If unsure, say N.
-+
  config VXFS_FS
         tristate "FreeVxFS file system support (VERITAS VxFS(TM) compatible)"
         depends on BLOCK
---- linux-2.6.24-rc1.orig/fs/Makefile
-+++ linux-2.6.24-rc1/fs/Makefile
-@@ -72,6 +72,7 @@
+diff -x .gitignore -Nurp linux-2.6.24/fs/Makefile linux-2.6.24-squashfs3.3/fs/Makefile
+--- linux-2.6.24/fs/Makefile    2007-10-25 17:41:45.000000000 +0100
++++ linux-2.6.24-squashfs3.3/fs/Makefile        2007-11-01 05:08:09.000000000 +0000
+@@ -72,6 +72,7 @@ obj-$(CONFIG_JBD)             += jbd/
  obj-$(CONFIG_JBD2)             += jbd2/
  obj-$(CONFIG_EXT2_FS)          += ext2/
  obj-$(CONFIG_CRAMFS)           += cramfs/
@@ -82,14 +69,15 @@
  obj-y                          += ramfs/
  obj-$(CONFIG_HUGETLBFS)                += hugetlbfs/
  obj-$(CONFIG_CODA_FS)          += coda/
---- /dev/null
-+++ linux-2.6.24-rc1/fs/squashfs/inode.c
-@@ -0,0 +1,2329 @@
+diff -x .gitignore -Nurp linux-2.6.24/fs/squashfs/inode.c linux-2.6.24-squashfs3.3/fs/squashfs/inode.c
+--- linux-2.6.24/fs/squashfs/inode.c    1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.24-squashfs3.3/fs/squashfs/inode.c        2007-11-01 05:05:00.000000000 +0000
+@@ -0,0 +1,2192 @@
 +/*
 + * Squashfs - a compressed read only filesystem for Linux
 + *
 + * Copyright (c) 2002, 2003, 2004, 2005, 2006, 2007
-+ * Phillip Lougher <phillip@lougher.org.uk>
++ * Phillip Lougher <phillip@lougher.demon.co.uk>
 + *
 + * This program is free software; you can redistribute it and/or
 + * modify it under the terms of the GNU General Public License
@@ -118,9 +106,12 @@
 +#include <linux/vfs.h>
 +#include <linux/vmalloc.h>
 +#include <linux/smp_lock.h>
++#include <linux/exportfs.h>
 +
 +#include "squashfs.h"
 +
++int squashfs_cached_blks;
++
 +static void vfs_read_inode(struct inode *i);
 +static struct dentry *squashfs_get_parent(struct dentry *child);
 +static int squashfs_read_inode(struct inode *i, squashfs_inode_t inode);
@@ -130,7 +121,6 @@
 +                               int readahead_blks, char *block_list,
 +                               unsigned short **block_p, unsigned int *bsize);
 +static int squashfs_readpage(struct file *file, struct page *page);
-+static int squashfs_readpage4K(struct file *file, struct page *page);
 +static int squashfs_readdir(struct file *, void *, filldir_t);
 +static struct dentry *squashfs_lookup(struct inode *, struct dentry *,
 +                               struct nameidata *);
@@ -183,10 +173,6 @@
 +       .readpage = squashfs_readpage
 +};
 +
-+SQSH_EXTERN const struct address_space_operations squashfs_aops_4K = {
-+       .readpage = squashfs_readpage4K
-+};
-+
 +static const struct file_operations squashfs_dir_ops = {
 +       .read = generic_read_dir,
 +       .readdir = squashfs_readdir
@@ -270,30 +256,36 @@
 +{
 +       struct squashfs_sb_info *msblk = s->s_fs_info;
 +       struct squashfs_super_block *sblk = &msblk->sblk;
-+       struct buffer_head *bh[((SQUASHFS_FILE_MAX_SIZE - 1) >>
-+                       msblk->devblksize_log2) + 2];
++       struct buffer_head **bh;
 +       unsigned int offset = index & ((1 << msblk->devblksize_log2) - 1);
 +       unsigned int cur_index = index >> msblk->devblksize_log2;
 +       int bytes, avail_bytes, b = 0, k = 0;
 +       unsigned int compressed;
 +       unsigned int c_byte = length;
 +
++       bh = kmalloc(((sblk->block_size >> msblk->devblksize_log2) + 1) *
++                                                               sizeof(struct buffer_head *), GFP_KERNEL);
++       if (bh == NULL)
++               goto read_failure;
++
 +       if (c_byte) {
 +               bytes = msblk->devblksize - offset;
 +               compressed = SQUASHFS_COMPRESSED_BLOCK(c_byte);
 +               c_byte = SQUASHFS_COMPRESSED_SIZE_BLOCK(c_byte);
 +
-+               TRACE("Block @ 0x%llx, %scompressed size %d, src size %d\n", index, compressed
-+                                       ? "" : "un", (unsigned int) c_byte, srclength);
++               TRACE("Block @ 0x%llx, %scompressed size %d, src size %d\n", index,
++                                       compressed ? "" : "un", (unsigned int) c_byte, srclength);
 +
 +               if (c_byte > srclength || index < 0 || (index + c_byte) > sblk->bytes_used)
 +                       goto read_failure;
 +
-+               if (!(bh[0] = sb_getblk(s, cur_index)))
++               bh[0] = sb_getblk(s, cur_index);
++               if (bh[0] == NULL)
 +                       goto block_release;
 +
 +               for (b = 1; bytes < c_byte; b++) {
-+                       if (!(bh[b] = sb_getblk(s, ++cur_index)))
++                       bh[b] = sb_getblk(s, ++cur_index);
++                       if (bh[b] == NULL)
 +                               goto block_release;
 +                       bytes += msblk->devblksize;
 +               }
@@ -302,8 +294,8 @@
 +               if (index < 0 || (index + 2) > sblk->bytes_used)
 +                       goto read_failure;
 +
-+               if (!(bh[0] = get_block_length(s, &cur_index, &offset,
-+                                                               &c_byte)))
++               bh[0] = get_block_length(s, &cur_index, &offset, &c_byte);
++               if (bh[0] == NULL)
 +                       goto read_failure;
 +
 +               bytes = msblk->devblksize - offset;
@@ -317,7 +309,8 @@
 +                       goto read_failure;
 +
 +               for (b = 1; bytes < c_byte; b++) {
-+                       if (!(bh[b] = sb_getblk(s, ++cur_index)))
++                       bh[b] = sb_getblk(s, ++cur_index);
++                       if (bh[b] == NULL)
 +                               goto block_release;
 +                       bytes += msblk->devblksize;
 +               }
@@ -337,9 +330,8 @@
 +               msblk->stream.avail_out = srclength;
 +
 +               for (bytes = 0; k < b; k++) {
-+                       avail_bytes = (c_byte - bytes) > (msblk->devblksize - offset) ?
-+                                       msblk->devblksize - offset :
-+                                       c_byte - bytes;
++                       avail_bytes = min(c_byte - bytes, msblk->devblksize - offset);
++
 +                       wait_on_buffer(bh[k]);
 +                       if (!buffer_uptodate(bh[k]))
 +                               goto release_mutex;
@@ -350,8 +342,8 @@
 +                       if (k == 0) {
 +                               zlib_err = zlib_inflateInit(&msblk->stream);
 +                               if (zlib_err != Z_OK) {
-+                                       ERROR("zlib_inflateInit returned unexpected result 0x%x, srclength %d\n",
-+                                               zlib_err, srclength);
++                                       ERROR("zlib_inflateInit returned unexpected result 0x%x,"
++                                               " srclength %d\n", zlib_err, srclength);
 +                                       goto release_mutex;
 +                               }
 +
@@ -364,8 +356,9 @@
 +
 +                       zlib_err = zlib_inflate(&msblk->stream, Z_NO_FLUSH);
 +                       if (zlib_err != Z_OK && zlib_err != Z_STREAM_END) {
-+                               ERROR("zlib_inflate returned unexpected result 0x%x, srclength %d, avail_in %d, avail_out %d\n",
-+                                       zlib_err, srclength, msblk->stream.avail_in, msblk->stream.avail_out);
++                               ERROR("zlib_inflate returned unexpected result 0x%x,"
++                                       " srclength %d, avail_in %d, avail_out %d\n", zlib_err,
++                                       srclength, msblk->stream.avail_in, msblk->stream.avail_out);
 +                               goto release_mutex;
 +                       }
 +
@@ -379,8 +372,8 @@
 +
 +               zlib_err = zlib_inflateEnd(&msblk->stream);
 +               if (zlib_err != Z_OK) {
-+                       ERROR("zlib_inflateEnd returned unexpected result 0x%x, srclength %d\n",
-+                               zlib_err, srclength);
++                       ERROR("zlib_inflateEnd returned unexpected result 0x%x,"
++                               " srclength %d\n", zlib_err, srclength);
 +                       goto release_mutex;
 +               }
 +               bytes = msblk->stream.total_out;
@@ -390,14 +383,13 @@
 +
 +               for(i = 0; i < b; i++) {
 +                       wait_on_buffer(bh[i]);
-+                       if(!buffer_uptodate(bh[i]))
++                       if (!buffer_uptodate(bh[i]))
 +                               goto block_release;
 +               }
 +
 +               for (bytes = 0; k < b; k++) {
-+                       avail_bytes = (c_byte - bytes) > (msblk->devblksize - offset) ?
-+                                       msblk->devblksize - offset :
-+                                       c_byte - bytes;
++                       avail_bytes = min(c_byte - bytes, msblk->devblksize - offset);
++
 +                       memcpy(buffer + bytes, bh[k]->b_data + offset, avail_bytes);
 +                       bytes += avail_bytes;
 +                       offset = 0;
@@ -407,8 +399,9 @@
 +
 +       if (next_index)
 +               *next_index = index + c_byte + (length ? 0 :
-+                               (SQUASHFS_CHECK_DATA(msblk->sblk.flags)
-+                                ? 3 : 2));
++                               (SQUASHFS_CHECK_DATA(msblk->sblk.flags) ? 3 : 2));
++
++       kfree(bh);
 +       return bytes;
 +
 +release_mutex:
@@ -420,11 +413,12 @@
 +
 +read_failure:
 +       ERROR("sb_bread failed reading block 0x%x\n", cur_index);
++       kfree(bh);
 +       return 0;
 +}
 +
 +
-+SQSH_EXTERN int squashfs_get_cached_block(struct super_block *s, char *buffer,
++SQSH_EXTERN int squashfs_get_cached_block(struct super_block *s, void *buffer,
 +                               long long block, unsigned int offset,
 +                               int length, long long *next_block,
 +                               unsigned int *next_offset)
@@ -435,68 +429,65 @@
 +
 +       TRACE("Entered squashfs_get_cached_block [%llx:%x]\n", block, offset);
 +
-+       while ( 1 ) {
-+               for (i = 0; i < SQUASHFS_CACHED_BLKS; i++) 
++       while (1) {
++               for (i = 0; i < squashfs_cached_blks; i++) 
 +                       if (msblk->block_cache[i].block == block)
 +                               break; 
 +               
 +               mutex_lock(&msblk->block_cache_mutex);
 +
-+               if (i == SQUASHFS_CACHED_BLKS) {
++               if (i == squashfs_cached_blks) {
 +                       /* read inode header block */
-+                       for (i = msblk->next_cache, n = SQUASHFS_CACHED_BLKS;
-+                                       n ; n --, i = (i + 1) %
-+                                       SQUASHFS_CACHED_BLKS)
-+                               if (msblk->block_cache[i].block !=
-+                                                       SQUASHFS_USED_BLK)
++                       if (msblk->unused_cache_blks == 0) {
++                               mutex_unlock(&msblk->block_cache_mutex);
++                               wait_event(msblk->waitq, msblk->unused_cache_blks);
++                               continue;
++                       }
++
++                       i = msblk->next_cache;
++                       for (n = 0; n < squashfs_cached_blks; n++) {
++                               if (msblk->block_cache[i].block != SQUASHFS_USED_BLK)
 +                                       break;
++                               i = (i + 1) % squashfs_cached_blks;
++                       }
 +
-+                       if (n == 0) {
-+                               wait_queue_t wait;
++                       msblk->next_cache = (i + 1) % squashfs_cached_blks;
 +
-+                               init_waitqueue_entry(&wait, current);
-+                               add_wait_queue(&msblk->waitq, &wait);
-+                               set_current_state(TASK_UNINTERRUPTIBLE);
-+                               mutex_unlock(&msblk->block_cache_mutex);
-+                               schedule();
-+                               set_current_state(TASK_RUNNING);
-+                               remove_wait_queue(&msblk->waitq, &wait);
-+                               continue;
-+                       }
-+                       msblk->next_cache = (i + 1) % SQUASHFS_CACHED_BLKS;
-+
-+                       if (msblk->block_cache[i].block ==
-+                                                       SQUASHFS_INVALID_BLK) {
-+                               if (!(msblk->block_cache[i].data =
-+                                               kmalloc(SQUASHFS_METADATA_SIZE,
-+                                               GFP_KERNEL))) {
-+                                       ERROR("Failed to allocate cache"
-+                                                       "block\n");
++                       if (msblk->block_cache[i].block == SQUASHFS_INVALID_BLK) {
++                               msblk->block_cache[i].data = vmalloc(SQUASHFS_METADATA_SIZE);
++                               if (msblk->block_cache[i].data == NULL) {
++                                       ERROR("Failed to allocate cache block\n");
 +                                       mutex_unlock(&msblk->block_cache_mutex);
 +                                       goto out;
 +                               }
 +                       }
 +       
 +                       msblk->block_cache[i].block = SQUASHFS_USED_BLK;
++                       msblk->unused_cache_blks --;
 +                       mutex_unlock(&msblk->block_cache_mutex);
 +
 +                       msblk->block_cache[i].length = squashfs_read_data(s,
-+                               msblk->block_cache[i].data, block, 0, &next_index, SQUASHFS_METADATA_SIZE);
++                               msblk->block_cache[i].data, block, 0, &next_index,
++                               SQUASHFS_METADATA_SIZE);
++
 +                       if (msblk->block_cache[i].length == 0) {
-+                               ERROR("Unable to read cache block [%llx:%x]\n",
-+                                               block, offset);
++                               ERROR("Unable to read cache block [%llx:%x]\n", block, offset);
 +                               mutex_lock(&msblk->block_cache_mutex);
 +                               msblk->block_cache[i].block = SQUASHFS_INVALID_BLK;
-+                               kfree(msblk->block_cache[i].data);
++                               msblk->unused_cache_blks ++;
++                               smp_mb();
++                               vfree(msblk->block_cache[i].data);
 +                               wake_up(&msblk->waitq);
 +                               mutex_unlock(&msblk->block_cache_mutex);
 +                               goto out;
 +                       }
 +
 +                       mutex_lock(&msblk->block_cache_mutex);
-+                       wake_up(&msblk->waitq);
 +                       msblk->block_cache[i].block = block;
 +                       msblk->block_cache[i].next_index = next_index;
++                       msblk->unused_cache_blks ++;
++                       smp_mb();
++                       wake_up(&msblk->waitq);
 +                       TRACE("Read cache block [%llx:%x]\n", block, offset);
 +               }
 +
@@ -512,8 +503,7 @@
 +                       goto out;
 +               } else if (bytes >= length) {
 +                       if (buffer)
-+                               memcpy(buffer, msblk->block_cache[i].data +
-+                                               offset, length);
++                               memcpy(buffer, msblk->block_cache[i].data + offset, length);
 +                       if (msblk->block_cache[i].length - offset == length) {
 +                               *next_block = msblk->block_cache[i].next_index;
 +                               *next_offset = 0;
@@ -525,9 +515,8 @@
 +                       goto finish;
 +               } else {
 +                       if (buffer) {
-+                               memcpy(buffer, msblk->block_cache[i].data +
-+                                               offset, bytes);
-+                               buffer += bytes;
++                               memcpy(buffer, msblk->block_cache[i].data + offset, bytes);
++                               buffer = (char *) buffer + bytes;
 +                       }
 +                       block = msblk->block_cache[i].next_index;
 +                       mutex_unlock(&msblk->block_cache_mutex);
@@ -556,17 +545,13 @@
 +       if (msblk->swap) {
 +               struct squashfs_fragment_entry sfragment_entry;
 +
-+               if (!squashfs_get_cached_block(s, (char *) &sfragment_entry,
-+                                       start_block, offset,
-+                                       sizeof(sfragment_entry), &start_block,
-+                                       &offset))
++               if (!squashfs_get_cached_block(s, &sfragment_entry, start_block, offset,
++                                        sizeof(sfragment_entry), &start_block, &offset))
 +                       goto out;
 +               SQUASHFS_SWAP_FRAGMENT_ENTRY(&fragment_entry, &sfragment_entry);
 +       } else
-+               if (!squashfs_get_cached_block(s, (char *) &fragment_entry,
-+                                       start_block, offset,
-+                                       sizeof(fragment_entry), &start_block,
-+                                       &offset))
++               if (!squashfs_get_cached_block(s, &fragment_entry, start_block, offset,
++                                        sizeof(fragment_entry), &start_block, &offset))
 +                       goto out;
 +
 +       *fragment_start_block = fragment_entry.start_block;
@@ -579,90 +564,92 @@
 +}
 +
 +
-+SQSH_EXTERN void release_cached_fragment(struct squashfs_sb_info *msblk, struct
-+                                       squashfs_fragment_cache *fragment)
++SQSH_EXTERN void release_cached_fragment(struct squashfs_sb_info *msblk,
++                               struct squashfs_fragment_cache *fragment)
 +{
 +       mutex_lock(&msblk->fragment_mutex);
 +       fragment->locked --;
-+       wake_up(&msblk->fragment_wait_queue);
++       if (fragment->locked == 0) {
++               msblk->unused_frag_blks ++;
++               smp_mb();
++               wake_up(&msblk->fragment_wait_queue);
++       }
 +       mutex_unlock(&msblk->fragment_mutex);
 +}
 +
 +
-+SQSH_EXTERN struct squashfs_fragment_cache *get_cached_fragment(struct super_block
-+                                       *s, long long start_block,
-+                                       int length)
++SQSH_EXTERN
++struct squashfs_fragment_cache *get_cached_fragment(struct super_block *s,
++                               long long start_block, int length)
 +{
 +       int i, n;
 +       struct squashfs_sb_info *msblk = s->s_fs_info;
 +       struct squashfs_super_block *sblk = &msblk->sblk;
 +
-+       while ( 1 ) {
++       while (1) {
 +               mutex_lock(&msblk->fragment_mutex);
 +
 +               for (i = 0; i < SQUASHFS_CACHED_FRAGMENTS &&
 +                               msblk->fragment[i].block != start_block; i++);
 +
 +               if (i == SQUASHFS_CACHED_FRAGMENTS) {
-+                       for (i = msblk->next_fragment, n =
-+                               SQUASHFS_CACHED_FRAGMENTS; n &&
-+                               msblk->fragment[i].locked; n--, i = (i + 1) %
-+                               SQUASHFS_CACHED_FRAGMENTS);
-+
-+                       if (n == 0) {
-+                               wait_queue_t wait;
-+
-+                               init_waitqueue_entry(&wait, current);
-+                               add_wait_queue(&msblk->fragment_wait_queue,
-+                                                                       &wait);
-+                               set_current_state(TASK_UNINTERRUPTIBLE);
++                       if (msblk->unused_frag_blks == 0) {
 +                               mutex_unlock(&msblk->fragment_mutex);
-+                               schedule();
-+                               set_current_state(TASK_RUNNING);
-+                               remove_wait_queue(&msblk->fragment_wait_queue,
-+                                                                       &wait);
++                               wait_event(msblk->fragment_wait_queue, msblk->unused_frag_blks);
 +                               continue;
 +                       }
++
++                       i = msblk->next_fragment;
++                       for (n = 0; n < SQUASHFS_CACHED_FRAGMENTS; n++) {
++                               if (msblk->fragment[i].locked == 0)
++                                       break;
++                               i = (i + 1) % SQUASHFS_CACHED_FRAGMENTS;
++                       }
++
 +                       msblk->next_fragment = (msblk->next_fragment + 1) %
 +                               SQUASHFS_CACHED_FRAGMENTS;
 +                       
-+                       if (msblk->fragment[i].data == NULL)
-+                               if (!(msblk->fragment[i].data = SQUASHFS_ALLOC
-+                                               (SQUASHFS_FILE_MAX_SIZE))) {
-+                                       ERROR("Failed to allocate fragment "
-+                                                       "cache block\n");
++                       if (msblk->fragment[i].data == NULL) {
++                               msblk->fragment[i].data = vmalloc(sblk->block_size);
++                               if (msblk->fragment[i].data == NULL) {
++                                       ERROR("Failed to allocate fragment cache block\n");
 +                                       mutex_unlock(&msblk->fragment_mutex);
 +                                       goto out;
 +                               }
++                       }
 +
++                       msblk->unused_frag_blks --;
 +                       msblk->fragment[i].block = SQUASHFS_INVALID_BLK;
 +                       msblk->fragment[i].locked = 1;
 +                       mutex_unlock(&msblk->fragment_mutex);
 +
-+                       if (!(msblk->fragment[i].length = squashfs_read_data(s,
-+                                               msblk->fragment[i].data,
-+                                               start_block, length, NULL, sblk->block_size))) {
-+                               ERROR("Unable to read fragment cache block "
-+                                                       "[%llx]\n", start_block);
++                       msblk->fragment[i].length = squashfs_read_data(s,
++                               msblk->fragment[i].data, start_block, length, NULL,
++                               sblk->block_size);
++
++                       if (msblk->fragment[i].length == 0) {
++                               ERROR("Unable to read fragment cache block [%llx]\n", start_block);
 +                               msblk->fragment[i].locked = 0;
++                               msblk->unused_frag_blks ++;
 +                               smp_mb();
++                               wake_up(&msblk->fragment_wait_queue);
 +                               goto out;
 +                       }
 +
 +                       mutex_lock(&msblk->fragment_mutex);
 +                       msblk->fragment[i].block = start_block;
 +                       TRACE("New fragment %d, start block %lld, locked %d\n",
-+                                               i, msblk->fragment[i].block,
-+                                               msblk->fragment[i].locked);
++                               i, msblk->fragment[i].block, msblk->fragment[i].locked);
 +                       mutex_unlock(&msblk->fragment_mutex);
 +                       break;
 +               }
 +
++               if (msblk->fragment[i].locked == 0)
++                       msblk->unused_frag_blks --;
 +               msblk->fragment[i].locked++;
 +               mutex_unlock(&msblk->fragment_mutex);
 +               TRACE("Got fragment %d, start block %lld, locked %d\n", i,
-+                                               msblk->fragment[i].block,
-+                                               msblk->fragment[i].locked);
++                       msblk->fragment[i].block, msblk->fragment[i].locked);
 +               break;
 +       }
 +
@@ -674,7 +661,7 @@
 +
 +
 +static void squashfs_new_inode(struct squashfs_sb_info *msblk, struct inode *i,
-+               struct squashfs_base_inode_header *inodeb)
++                               struct squashfs_base_inode_header *inodeb)
 +{
 +       i->i_ino = inodeb->inode_number;
 +       i->i_mtime.tv_sec = inodeb->mtime;
@@ -683,6 +670,7 @@
 +       i->i_uid = msblk->uid[inodeb->uid];
 +       i->i_mode = inodeb->mode;
 +       i->i_size = 0;
++
 +       if (inodeb->guid == SQUASHFS_GUIDS)
 +               i->i_gid = i->i_uid;
 +       else
@@ -702,11 +690,11 @@
 +       if (msblk->swap) {
 +               squashfs_inode_t sinode;
 +
-+               if (!squashfs_get_cached_block(s, (char *) &sinode, start, offset,
++               if (!squashfs_get_cached_block(s, &sinode, start, offset,
 +                                       sizeof(sinode), &start, &offset))
 +                       goto out;
 +               SQUASHFS_SWAP_INODE_T((&inode), &sinode);
-+       } else if (!squashfs_get_cached_block(s, (char *) &inode, start, offset,
++       } else if (!squashfs_get_cached_block(s, &inode, start, offset,
 +                                       sizeof(inode), &start, &offset))
 +                       goto out;
 +
@@ -753,7 +741,8 @@
 +}
 +
 +       
-+SQSH_EXTERN struct inode *squashfs_iget(struct super_block *s, squashfs_inode_t inode, unsigned int inode_number)
++SQSH_EXTERN struct inode *squashfs_iget(struct super_block *s,
++                               squashfs_inode_t inode, unsigned int inode_number)
 +{
 +       struct squashfs_sb_info *msblk = s->s_fs_info;
 +       struct inode *i = iget_locked(s, inode_number);
@@ -774,28 +763,23 @@
 +       struct super_block *s = i->i_sb;
 +       struct squashfs_sb_info *msblk = s->s_fs_info;
 +       struct squashfs_super_block *sblk = &msblk->sblk;
-+       long long block = SQUASHFS_INODE_BLK(inode) +
-+               sblk->inode_table_start;
++       long long block = SQUASHFS_INODE_BLK(inode) + sblk->inode_table_start;
 +       unsigned int offset = SQUASHFS_INODE_OFFSET(inode);
 +       long long next_block;
 +       unsigned int next_offset;
 +       union squashfs_inode_header id, sid;
-+       struct squashfs_base_inode_header *inodeb = &id.base,
-+                                         *sinodeb = &sid.base;
++       struct squashfs_base_inode_header *inodeb = &id.base, *sinodeb = &sid.base;
 +
 +       TRACE("Entered squashfs_read_inode\n");
 +
 +       if (msblk->swap) {
-+               if (!squashfs_get_cached_block(s, (char *) sinodeb, block,
-+                                       offset, sizeof(*sinodeb), &next_block,
-+                                       &next_offset))
++               if (!squashfs_get_cached_block(s, sinodeb, block, offset,
++                                       sizeof(*sinodeb), &next_block, &next_offset))
 +                       goto failed_read;
-+               SQUASHFS_SWAP_BASE_INODE_HEADER(inodeb, sinodeb,
-+                                       sizeof(*sinodeb));
++               SQUASHFS_SWAP_BASE_INODE_HEADER(inodeb, sinodeb, sizeof(*sinodeb));
 +       } else
-+               if (!squashfs_get_cached_block(s, (char *) inodeb, block,
-+                                       offset, sizeof(*inodeb), &next_block,
-+                                       &next_offset))
++               if (!squashfs_get_cached_block(s, inodeb, block, offset,
++                                       sizeof(*inodeb), &next_block, &next_offset))
 +                       goto failed_read;
 +
 +       squashfs_new_inode(msblk, i, inodeb);
@@ -808,24 +792,21 @@
 +                       struct squashfs_reg_inode_header *sinodep = &sid.reg;
 +                               
 +                       if (msblk->swap) {
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               sinodep, block, offset,
-+                                               sizeof(*sinodep), &next_block,
-+                                               &next_offset))
++                               if (!squashfs_get_cached_block(s, sinodep, block, offset,
++                                               sizeof(*sinodep), &next_block, &next_offset))
 +                                       goto failed_read;
 +                               SQUASHFS_SWAP_REG_INODE_HEADER(inodep, sinodep);
 +                       } else
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               inodep, block, offset,
-+                                               sizeof(*inodep), &next_block,
-+                                               &next_offset))
++                               if (!squashfs_get_cached_block(s, inodep, block, offset,
++                                               sizeof(*inodep), &next_block, &next_offset))
 +                                       goto failed_read;
 +
 +                       frag_blk = SQUASHFS_INVALID_BLK;
-+                       if (inodep->fragment != SQUASHFS_INVALID_FRAG &&
-+                                       !get_fragment_location(s,
-+                                       inodep->fragment, &frag_blk, &frag_size))
-+                               goto failed_read;
++
++                       if (inodep->fragment != SQUASHFS_INVALID_FRAG)
++                                       if(!get_fragment_location(s, inodep->fragment, &frag_blk,
++                                                                                               &frag_size))
++                                               goto failed_read;
 +                               
 +                       i->i_nlink = 1;
 +                       i->i_size = inodep->file_size;
@@ -838,10 +819,7 @@
 +                       SQUASHFS_I(i)->start_block = inodep->start_block;
 +                       SQUASHFS_I(i)->u.s1.block_list_start = next_block;
 +                       SQUASHFS_I(i)->offset = next_offset;
-+                       if (sblk->block_size > 4096)
-+                               i->i_data.a_ops = &squashfs_aops;
-+                       else
-+                               i->i_data.a_ops = &squashfs_aops_4K;
++                       i->i_data.a_ops = &squashfs_aops;
 +
 +                       TRACE("File inode %x:%x, start_block %llx, "
 +                                       "block_list_start %llx, offset %x\n",
@@ -857,24 +835,21 @@
 +                       struct squashfs_lreg_inode_header *sinodep = &sid.lreg;
 +                               
 +                       if (msblk->swap) {
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               sinodep, block, offset,
-+                                               sizeof(*sinodep), &next_block,
-+                                               &next_offset))
++                               if (!squashfs_get_cached_block(s, sinodep, block, offset,
++                                               sizeof(*sinodep), &next_block, &next_offset))
 +                                       goto failed_read;
 +                               SQUASHFS_SWAP_LREG_INODE_HEADER(inodep, sinodep);
 +                       } else
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               inodep, block, offset,
-+                                               sizeof(*inodep), &next_block,
-+                                               &next_offset))
++                               if (!squashfs_get_cached_block(s, inodep, block, offset,
++                                               sizeof(*inodep), &next_block, &next_offset))
 +                                       goto failed_read;
 +
 +                       frag_blk = SQUASHFS_INVALID_BLK;
-+                       if (inodep->fragment != SQUASHFS_INVALID_FRAG &&
-+                                       !get_fragment_location(s,
-+                                       inodep->fragment, &frag_blk, &frag_size))
-+                               goto failed_read;
++
++                       if (inodep->fragment != SQUASHFS_INVALID_FRAG)
++                               if (!get_fragment_location(s, inodep->fragment, &frag_blk,
++                                                                                                &frag_size))
++                                       goto failed_read;
 +                               
 +                       i->i_nlink = inodep->nlink;
 +                       i->i_size = inodep->file_size;
@@ -887,10 +862,7 @@
 +                       SQUASHFS_I(i)->start_block = inodep->start_block;
 +                       SQUASHFS_I(i)->u.s1.block_list_start = next_block;
 +                       SQUASHFS_I(i)->offset = next_offset;
-+                       if (sblk->block_size > 4096)
-+                               i->i_data.a_ops = &squashfs_aops;
-+                       else
-+                               i->i_data.a_ops = &squashfs_aops_4K;
++                       i->i_data.a_ops = &squashfs_aops;
 +
 +                       TRACE("File inode %x:%x, start_block %llx, "
 +                                       "block_list_start %llx, offset %x\n",
@@ -904,17 +876,13 @@
 +                       struct squashfs_dir_inode_header *sinodep = &sid.dir;
 +
 +                       if (msblk->swap) {
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               sinodep, block, offset,
-+                                               sizeof(*sinodep), &next_block,
-+                                               &next_offset))
++                               if (!squashfs_get_cached_block(s, sinodep, block, offset,
++                                               sizeof(*sinodep), &next_block, &next_offset))
 +                                       goto failed_read;
 +                               SQUASHFS_SWAP_DIR_INODE_HEADER(inodep, sinodep);
 +                       } else
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               inodep, block, offset,
-+                                               sizeof(*inodep), &next_block,
-+                                               &next_offset))
++                               if (!squashfs_get_cached_block(s, inodep, block, offset,
++                                               sizeof(*inodep), &next_block, &next_offset))
 +                                       goto failed_read;
 +
 +                       i->i_nlink = inodep->nlink;
@@ -938,18 +906,13 @@
 +                       struct squashfs_ldir_inode_header *sinodep = &sid.ldir;
 +
 +                       if (msblk->swap) {
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               sinodep, block, offset,
-+                                               sizeof(*sinodep), &next_block,
-+                                               &next_offset))
++                               if (!squashfs_get_cached_block(s, sinodep, block, offset,
++                                               sizeof(*sinodep), &next_block, &next_offset))
 +                                       goto failed_read;
-+                               SQUASHFS_SWAP_LDIR_INODE_HEADER(inodep,
-+                                               sinodep);
++                               SQUASHFS_SWAP_LDIR_INODE_HEADER(inodep, sinodep);
 +                       } else
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               inodep, block, offset,
-+                                               sizeof(*inodep), &next_block,
-+                                               &next_offset))
++                               if (!squashfs_get_cached_block(s, inodep, block, offset,
++                                               sizeof(*inodep), &next_block, &next_offset))
 +                                       goto failed_read;
 +
 +                       i->i_nlink = inodep->nlink;
@@ -960,37 +923,27 @@
 +                       SQUASHFS_I(i)->start_block = inodep->start_block;
 +                       SQUASHFS_I(i)->offset = inodep->offset;
 +                       SQUASHFS_I(i)->u.s2.directory_index_start = next_block;
-+                       SQUASHFS_I(i)->u.s2.directory_index_offset =
-+                                                               next_offset;
-+                       SQUASHFS_I(i)->u.s2.directory_index_count =
-+                                                               inodep->i_count;
++                       SQUASHFS_I(i)->u.s2.directory_index_offset = next_offset;
++                       SQUASHFS_I(i)->u.s2.directory_index_count = inodep->i_count;
 +                       SQUASHFS_I(i)->u.s2.parent_inode = inodep->parent_inode;
 +
-+                       TRACE("Long directory inode %x:%x, start_block %x, "
-+                                       "offset %x\n",
++                       TRACE("Long directory inode %x:%x, start_block %x, offset %x\n",
 +                                       SQUASHFS_INODE_BLK(inode), offset,
 +                                       inodep->start_block, inodep->offset);
 +                       break;
 +               }
 +               case SQUASHFS_SYMLINK_TYPE: {
-+                       struct squashfs_symlink_inode_header *inodep =
-+                                                               &id.symlink;
-+                       struct squashfs_symlink_inode_header *sinodep =
-+                                                               &sid.symlink;
++                       struct squashfs_symlink_inode_header *inodep = &id.symlink;
++                       struct squashfs_symlink_inode_header *sinodep = &sid.symlink;
 +       
 +                       if (msblk->swap) {
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               sinodep, block, offset,
-+                                               sizeof(*sinodep), &next_block,
-+                                               &next_offset))
++                               if (!squashfs_get_cached_block(s, sinodep, block, offset,
++                                               sizeof(*sinodep), &next_block, &next_offset))
 +                                       goto failed_read;
-+                               SQUASHFS_SWAP_SYMLINK_INODE_HEADER(inodep,
-+                                                               sinodep);
++                               SQUASHFS_SWAP_SYMLINK_INODE_HEADER(inodep, sinodep);
 +                       } else
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               inodep, block, offset,
-+                                               sizeof(*inodep), &next_block,
-+                                               &next_offset))
++                               if (!squashfs_get_cached_block(s, inodep, block, offset,
++                                               sizeof(*inodep), &next_block, &next_offset))
 +                                       goto failed_read;
 +
 +                       i->i_nlink = inodep->nlink;
@@ -1001,8 +954,7 @@
 +                       SQUASHFS_I(i)->start_block = next_block;
 +                       SQUASHFS_I(i)->offset = next_offset;
 +
-+                       TRACE("Symbolic link inode %x:%x, start_block %llx, "
-+                                       "offset %x\n",
++                       TRACE("Symbolic link inode %x:%x, start_block %llx, offset %x\n",
 +                                       SQUASHFS_INODE_BLK(inode), offset,
 +                                       next_block, next_offset);
 +                       break;
@@ -1013,29 +965,22 @@
 +                       struct squashfs_dev_inode_header *sinodep = &sid.dev;
 +
 +                       if (msblk->swap) {
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               sinodep, block, offset,
-+                                               sizeof(*sinodep), &next_block,
-+                                               &next_offset))
++                               if (!squashfs_get_cached_block(s, sinodep, block, offset,
++                                               sizeof(*sinodep), &next_block, &next_offset))
 +                                       goto failed_read;
 +                               SQUASHFS_SWAP_DEV_INODE_HEADER(inodep, sinodep);
 +                       } else  
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               inodep, block, offset,
-+                                               sizeof(*inodep), &next_block,
-+                                               &next_offset))
++                               if (!squashfs_get_cached_block(s, inodep, block, offset,
++                                               sizeof(*inodep), &next_block, &next_offset))
 +                                       goto failed_read;
 +
 +                       i->i_nlink = inodep->nlink;
-+                       i->i_mode |= (inodeb->inode_type ==
-+                                       SQUASHFS_CHRDEV_TYPE) ?  S_IFCHR :
-+                                       S_IFBLK;
-+                       init_special_inode(i, i->i_mode,
-+                                       old_decode_dev(inodep->rdev));
++                       i->i_mode |= (inodeb->inode_type == SQUASHFS_CHRDEV_TYPE) ?
++                                       S_IFCHR : S_IFBLK;
++                       init_special_inode(i, i->i_mode, old_decode_dev(inodep->rdev));
 +
 +                       TRACE("Device inode %x:%x, rdev %x\n",
-+                                       SQUASHFS_INODE_BLK(inode), offset,
-+                                       inodep->rdev);
++                                       SQUASHFS_INODE_BLK(inode), offset, inodep->rdev);
 +                       break;
 +                }
 +                case SQUASHFS_FIFO_TYPE:
@@ -1044,17 +989,13 @@
 +                       struct squashfs_ipc_inode_header *sinodep = &sid.ipc;
 +
 +                       if (msblk->swap) {
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               sinodep, block, offset,
-+                                               sizeof(*sinodep), &next_block,
-+                                               &next_offset))
++                               if (!squashfs_get_cached_block(s, sinodep, block, offset,
++                                               sizeof(*sinodep), &next_block, &next_offset))
 +                                       goto failed_read;
 +                               SQUASHFS_SWAP_IPC_INODE_HEADER(inodep, sinodep);
 +                       } else  
-+                               if (!squashfs_get_cached_block(s, (char *)
-+                                               inodep, block, offset,
-+                                               sizeof(*inodep), &next_block,
-+                                               &next_offset))
++                               if (!squashfs_get_cached_block(s, inodep, block, offset,
++                                               sizeof(*inodep), &next_block, &next_offset))
 +                                       goto failed_read;
 +
 +                       i->i_nlink = inodep->nlink;
@@ -1089,7 +1030,8 @@
 +       TRACE("In read_inode_lookup_table, length %d\n", length);
 +
 +       /* Allocate inode lookup table */
-+       if (!(msblk->inode_lookup_table = kmalloc(length, GFP_KERNEL))) {
++       msblk->inode_lookup_table = kmalloc(length, GFP_KERNEL);
++       if (msblk->inode_lookup_table == NULL) {
 +               ERROR("Failed to allocate inode lookup table\n");
 +               return 0;
 +       }
@@ -1106,6 +1048,7 @@
 +               long long block;
 +
 +               for (i = 0; i < SQUASHFS_LOOKUP_BLOCKS(sblk->inodes); i++) {
++                       /* XXX */
 +                       SQUASHFS_SWAP_LOOKUP_BLOCKS((&block),
 +                                               &msblk->inode_lookup_table[i], 1);
 +                       msblk->inode_lookup_table[i] = block;
@@ -1126,7 +1069,8 @@
 +               return 1;
 +
 +       /* Allocate fragment index table */
-+       if (!(msblk->fragment_index = kmalloc(length, GFP_KERNEL))) {
++       msblk->fragment_index = kmalloc(length, GFP_KERNEL);
++       if (msblk->fragment_index == NULL) {
 +               ERROR("Failed to allocate fragment index table\n");
 +               return 0;
 +       }
@@ -1143,6 +1087,7 @@
 +               long long fragment;
 +
 +               for (i = 0; i < SQUASHFS_FRAGMENT_INDEXES(sblk->fragments); i++) {
++                       /* XXX */
 +                       SQUASHFS_SWAP_FRAGMENT_INDEXES((&fragment),
 +                                               &msblk->fragment_index[i], 1);
 +                       msblk->fragment_index[i] = fragment;
@@ -1153,6 +1098,34 @@
 +}
 +
 +
++static int readahead_metadata(struct super_block *s)
++{
++       struct squashfs_sb_info *msblk = s->s_fs_info;
++       int i;
++
++       squashfs_cached_blks = SQUASHFS_CACHED_BLKS;
++
++       /* Init inode_table block pointer array */
++       msblk->block_cache = kmalloc(sizeof(struct squashfs_cache) *
++                                       squashfs_cached_blks, GFP_KERNEL);
++       if (msblk->block_cache == NULL) {
++               ERROR("Failed to allocate block cache\n");
++               goto failed;
++       }
++
++       for (i = 0; i < squashfs_cached_blks; i++)
++               msblk->block_cache[i].block = SQUASHFS_INVALID_BLK;
++
++       msblk->next_cache = 0;
++       msblk->unused_cache_blks = squashfs_cached_blks;
++
++       return 1;
++
++failed:
++       return 0;
++}
++
++
 +static int supported_squashfs_filesystem(struct squashfs_sb_info *msblk, int silent)
 +{
 +       struct squashfs_super_block *sblk = &msblk->sblk;
@@ -1165,16 +1138,14 @@
 +               if (!squashfs_1_0_supported(msblk)) {
 +                       SERROR("Major/Minor mismatch, Squashfs 1.0 filesystems "
 +                               "are unsupported\n");
-+                       SERROR("Please recompile with "
-+                               "Squashfs 1.0 support enabled\n");
++                       SERROR("Please recompile with Squashfs 1.0 support enabled\n");
 +                       return 0;
 +               }
 +       } else if (sblk->s_major == 2) {
 +               if (!squashfs_2_0_supported(msblk)) {
 +                       SERROR("Major/Minor mismatch, Squashfs 2.0 filesystems "
 +                               "are unsupported\n");
-+                       SERROR("Please recompile with "
-+                               "Squashfs 2.0 support enabled\n");
++                       SERROR("Please recompile with Squashfs 2.0 support enabled\n");
 +                       return 0;
 +               }
 +       } else if(sblk->s_major != SQUASHFS_MAJOR || sblk->s_minor >
@@ -1197,16 +1168,17 @@
 +       char b[BDEVNAME_SIZE];
 +       struct inode *root;
 +
-+       TRACE("Entered squashfs_read_superblock\n");
++       TRACE("Entered squashfs_fill_superblock\n");
 +
-+       if (!(s->s_fs_info = kmalloc(sizeof(struct squashfs_sb_info),
-+                                               GFP_KERNEL))) {
++       s->s_fs_info = kzalloc(sizeof(struct squashfs_sb_info), GFP_KERNEL);
++       if (s->s_fs_info == NULL) {
 +               ERROR("Failed to allocate superblock\n");
 +               goto failure;
 +       }
-+       memset(s->s_fs_info, 0, sizeof(struct squashfs_sb_info));
 +       msblk = s->s_fs_info;
-+       if (!(msblk->stream.workspace = vmalloc(zlib_inflate_workspacesize()))) {
++
++       msblk->stream.workspace = vmalloc(zlib_inflate_workspacesize());
++       if (msblk->stream.workspace == NULL) {
 +               ERROR("Failed to allocate zlib workspace\n");
 +               goto failure;
 +       }
@@ -1224,6 +1196,9 @@
 +       init_waitqueue_head(&msblk->waitq);
 +       init_waitqueue_head(&msblk->fragment_wait_queue);
 +
++       /* sblk->bytes_used is checked in squashfs_read_data to ensure reads are not
++        * beyond filesystem end.  As we're using squashfs_read_data to read sblk here,
++        * first set sblk->bytes_used to a useful value */
 +       sblk->bytes_used = sizeof(struct squashfs_super_block);
 +       if (!squashfs_read_data(s, (char *) sblk, SQUASHFS_START,
 +                                       sizeof(struct squashfs_super_block) |
@@ -1233,13 +1208,12 @@
 +       }
 +
 +       /* Check it is a SQUASHFS superblock */
-+       msblk->swap = 0;
 +       if ((s->s_magic = sblk->s_magic) != SQUASHFS_MAGIC) {
 +               if (sblk->s_magic == SQUASHFS_MAGIC_SWAP) {
 +                       struct squashfs_super_block ssblk;
 +
-+                       WARNING("Mounting a different endian SQUASHFS "
-+                               "filesystem on %s\n", bdevname(s->s_bdev, b));
++                       WARNING("Mounting a different endian SQUASHFS filesystem on %s\n",
++                               bdevname(s->s_bdev, b));
 +
 +                       SQUASHFS_SWAP_SUPER_BLOCK(&ssblk, sblk);
 +                       memcpy(sblk, &ssblk, sizeof(struct squashfs_super_block));
@@ -1265,15 +1239,12 @@
 +               goto failed_mount;
 +
 +       TRACE("Found valid superblock on %s\n", bdevname(s->s_bdev, b));
-+       TRACE("Inodes are %scompressed\n",
-+                                       SQUASHFS_UNCOMPRESSED_INODES
-+                                       (sblk->flags) ? "un" : "");
-+       TRACE("Data is %scompressed\n",
-+                                       SQUASHFS_UNCOMPRESSED_DATA(sblk->flags)
++       TRACE("Inodes are %scompressed\n", SQUASHFS_UNCOMPRESSED_INODES(sblk->flags)
++                                       ? "un" : "");
++       TRACE("Data is %scompressed\n", SQUASHFS_UNCOMPRESSED_DATA(sblk->flags)
 +                                       ? "un" : "");
-+       TRACE("Check data is %s present in the filesystem\n",
-+                                       SQUASHFS_CHECK_DATA(sblk->flags) ?
-+                                       "" : "not");
++       TRACE("Check data is %spresent in the filesystem\n",
++                                       SQUASHFS_CHECK_DATA(sblk->flags) ?  "" : "not ");
 +       TRACE("Filesystem size %lld bytes\n", sblk->bytes_used);
 +       TRACE("Block size %d\n", sblk->block_size);
 +       TRACE("Number of inodes %d\n", sblk->inodes);
@@ -1284,34 +1255,27 @@
 +       TRACE("sblk->inode_table_start %llx\n", sblk->inode_table_start);
 +       TRACE("sblk->directory_table_start %llx\n", sblk->directory_table_start);
 +       if (sblk->s_major > 1)
-+               TRACE("sblk->fragment_table_start %llx\n",
-+                                       sblk->fragment_table_start);
++               TRACE("sblk->fragment_table_start %llx\n", sblk->fragment_table_start);
 +       TRACE("sblk->uid_start %llx\n", sblk->uid_start);
 +
++       s->s_maxbytes = MAX_LFS_FILESIZE;
 +       s->s_flags |= MS_RDONLY;
 +       s->s_op = &squashfs_super_ops;
 +
-+       /* Init inode_table block pointer array */
-+       if (!(msblk->block_cache = kmalloc(sizeof(struct squashfs_cache) *
-+                                       SQUASHFS_CACHED_BLKS, GFP_KERNEL))) {
-+               ERROR("Failed to allocate block cache\n");
++       if (readahead_metadata(s) == 0)
 +               goto failed_mount;
-+       }
-+
-+       for (i = 0; i < SQUASHFS_CACHED_BLKS; i++)
-+               msblk->block_cache[i].block = SQUASHFS_INVALID_BLK;
-+
-+       msblk->next_cache = 0;
 +
 +       /* Allocate read_page block */
-+       if (!(msblk->read_page = kmalloc(sblk->block_size, GFP_KERNEL))) {
++       msblk->read_page = vmalloc(sblk->block_size);
++       if (msblk->read_page == NULL) {
 +               ERROR("Failed to allocate read_page block\n");
 +               goto failed_mount;
 +       }
 +
 +       /* Allocate uid and gid tables */
-+       if (!(msblk->uid = kmalloc((sblk->no_uids + sblk->no_guids) *
-+                                       sizeof(unsigned int), GFP_KERNEL))) {
++       msblk->uid = kmalloc((sblk->no_uids + sblk->no_guids) *
++                                       sizeof(unsigned int), GFP_KERNEL);
++       if (msblk->uid == NULL) {
 +               ERROR("Failed to allocate uid/gid table\n");
 +               goto failed_mount;
 +       }
@@ -1343,19 +1307,19 @@
 +       if (sblk->s_major == 1 && squashfs_1_0_supported(msblk))
 +               goto allocate_root;
 +
-+       if (!(msblk->fragment = kmalloc(sizeof(struct squashfs_fragment_cache) *
-+                               SQUASHFS_CACHED_FRAGMENTS, GFP_KERNEL))) {
++       msblk->fragment = kzalloc(sizeof(struct squashfs_fragment_cache) *
++                               SQUASHFS_CACHED_FRAGMENTS, GFP_KERNEL);
++       if (msblk->fragment == NULL) {
 +               ERROR("Failed to allocate fragment block cache\n");
 +               goto failed_mount;
 +       }
 +
 +       for (i = 0; i < SQUASHFS_CACHED_FRAGMENTS; i++) {
-+               msblk->fragment[i].locked = 0;
 +               msblk->fragment[i].block = SQUASHFS_INVALID_BLK;
-+               msblk->fragment[i].data = NULL;
 +       }
 +
 +       msblk->next_fragment = 0;
++       msblk->unused_frag_blks = SQUASHFS_CACHED_FRAGMENTS;
 +
 +       /* Allocate and read fragment index table */
 +       if (msblk->read_fragment_index_table(s) == 0)
@@ -1377,13 +1341,14 @@
 +               goto failed_mount;
 +       insert_inode_hash(root);
 +
-+       if ((s->s_root = d_alloc_root(root)) == NULL) {
++       s->s_root = d_alloc_root(root);
++       if (s->s_root == NULL) {
 +               ERROR("Root inode create failed\n");
 +               iput(root);
 +               goto failed_mount;
 +       }
 +
-+       TRACE("Leaving squashfs_read_super\n");
++       TRACE("Leaving squashfs_fill_super\n");
 +       return 0;
 +
 +failed_mount:
@@ -1391,7 +1356,7 @@
 +       kfree(msblk->fragment_index);
 +       kfree(msblk->fragment);
 +       kfree(msblk->uid);
-+       kfree(msblk->read_page);
++       vfree(msblk->read_page);
 +       kfree(msblk->block_cache);
 +       kfree(msblk->fragment_index_2);
 +       vfree(msblk->stream.workspace);
@@ -1426,7 +1391,7 @@
 +static int squashfs_symlink_readpage(struct file *file, struct page *page)
 +{
 +       struct inode *inode = page->mapping->host;
-+       int index = page->index << PAGE_CACHE_SHIFT, length, bytes;
++       int index = page->index << PAGE_CACHE_SHIFT, length, bytes, avail_bytes;
 +       long long block = SQUASHFS_I(inode)->start_block;
 +       int offset = SQUASHFS_I(inode)->offset;
 +       void *pageaddr = kmap(page);
@@ -1437,11 +1402,10 @@
 +                               SQUASHFS_I(inode)->offset);
 +
 +       for (length = 0; length < index; length += bytes) {
-+               if (!(bytes = squashfs_get_cached_block(inode->i_sb, NULL,
-+                               block, offset, PAGE_CACHE_SIZE, &block,
-+                               &offset))) {
-+                       ERROR("Unable to read symbolic link [%llx:%x]\n", block,
-+                                       offset);
++               bytes = squashfs_get_cached_block(inode->i_sb, NULL, block,
++                               offset, PAGE_CACHE_SIZE, &block, &offset);
++               if (bytes == 0) {
++                       ERROR("Unable to read symbolic link [%llx:%x]\n", block, offset);
 +                       goto skip_read;
 +               }
 +       }
@@ -1452,11 +1416,11 @@
 +               goto skip_read;
 +       }
 +
-+       bytes = (i_size_read(inode) - length) > PAGE_CACHE_SIZE ? PAGE_CACHE_SIZE :
-+                                       i_size_read(inode) - length;
++       avail_bytes = min_t(int, i_size_read(inode) - length, PAGE_CACHE_SIZE);
 +
-+       if (!(bytes = squashfs_get_cached_block(inode->i_sb, pageaddr, block,
-+                                       offset, bytes, &block, &offset)))
++       bytes = squashfs_get_cached_block(inode->i_sb, pageaddr, block, offset,
++               avail_bytes, &block, &offset);
++       if (bytes == 0)
 +               ERROR("Unable to read symbolic link [%llx:%x]\n", block, offset);
 +
 +skip_read:
@@ -1480,10 +1444,10 @@
 +
 +       TRACE("locate_meta_index: index %d, offset %d\n", index, offset);
 +
-+       if(msblk->meta_index == NULL)
++       if (msblk->meta_index == NULL)
 +               goto not_allocated;
 +
-+       for (i = 0; i < SQUASHFS_META_NUMBER; i ++)
++       for (i = 0; i < SQUASHFS_META_NUMBER; i ++) {
 +               if (msblk->meta_index[i].inode_number == inode->i_ino &&
 +                               msblk->meta_index[i].offset >= offset &&
 +                               msblk->meta_index[i].offset <= index &&
@@ -1493,6 +1457,7 @@
 +                       meta = &msblk->meta_index[i];
 +                       offset = meta->offset;
 +               }
++       }
 +
 +       if (meta)
 +               meta->locked = 1;
@@ -1514,25 +1479,26 @@
 +
 +       TRACE("empty_meta_index: offset %d, skip %d\n", offset, skip);
 +
-+       if(msblk->meta_index == NULL) {
-+               if (!(msblk->meta_index = kmalloc(sizeof(struct meta_index) *
-+                                       SQUASHFS_META_NUMBER, GFP_KERNEL))) {
++       if (msblk->meta_index == NULL) {
++               msblk->meta_index = kmalloc(sizeof(struct meta_index) *
++                                       SQUASHFS_META_NUMBER, GFP_KERNEL);
++               if (msblk->meta_index == NULL) {
 +                       ERROR("Failed to allocate meta_index\n");
 +                       goto failed;
 +               }
-+               for(i = 0; i < SQUASHFS_META_NUMBER; i++) {
++               for (i = 0; i < SQUASHFS_META_NUMBER; i++) {
 +                       msblk->meta_index[i].inode_number = 0;
 +                       msblk->meta_index[i].locked = 0;
 +               }
 +               msblk->next_meta_index = 0;
 +       }
 +
-+       for(i = SQUASHFS_META_NUMBER; i &&
++       for (i = SQUASHFS_META_NUMBER; i &&
 +                       msblk->meta_index[msblk->next_meta_index].locked; i --)
 +               msblk->next_meta_index = (msblk->next_meta_index + 1) %
 +                       SQUASHFS_META_NUMBER;
 +
-+       if(i == 0) {
++       if (i == 0) {
 +               TRACE("empty_meta_index: failed!\n");
 +               goto failed;
 +       }
@@ -1565,7 +1531,7 @@
 +
 +
 +static int read_block_index(struct super_block *s, int blocks, char *block_list,
-+               long long *start_block, int *offset)
++                               long long *start_block, int *offset)
 +{
 +       struct squashfs_sb_info *msblk = s->s_fs_info;
 +       unsigned int *block_listp;
@@ -1576,19 +1542,18 @@
 +
 +               if (!squashfs_get_cached_block(s, sblock_list, *start_block,
 +                               *offset, blocks << 2, start_block, offset)) {
-+                       ERROR("Unable to read block list [%llx:%x]\n",
-+                               *start_block, *offset);
++                       ERROR("Fail reading block list [%llx:%x]\n", *start_block, *offset);
 +                       goto failure;
 +               }
 +               SQUASHFS_SWAP_INTS(((unsigned int *)block_list),
 +                               ((unsigned int *)sblock_list), blocks);
-+       } else
++       } else {
 +               if (!squashfs_get_cached_block(s, block_list, *start_block,
 +                               *offset, blocks << 2, start_block, offset)) {
-+                       ERROR("Unable to read block list [%llx:%x]\n",
-+                               *start_block, *offset);
++                       ERROR("Fail reading block list [%llx:%x]\n", *start_block, *offset);
 +                       goto failure;
 +               }
++       }
 +
 +       for (block_listp = (unsigned int *) block_list; blocks;
 +                               block_listp++, blocks --)
@@ -1626,25 +1591,26 @@
 + 
 +       index /= SQUASHFS_META_INDEXES * skip;
 +
-+       while ( offset < index ) {
++       while (offset < index) {
 +               meta = locate_meta_index(inode, index, offset + 1);
 +
 +               if (meta == NULL) {
-+                       if ((meta = empty_meta_index(inode, offset + 1,
-+                                                       skip)) == NULL)
++                       meta = empty_meta_index(inode, offset + 1, skip);
++                       if (meta == NULL)
 +                               goto all_done;
 +               } else {
 +                       if(meta->entries == 0)
 +                               goto failed;
++                       /* XXX */
 +                       offset = index < meta->offset + meta->entries ? index :
 +                               meta->offset + meta->entries - 1;
++                       /* XXX */
 +                       meta_entry = &meta->meta_entry[offset - meta->offset];
 +                       cur_index_block = meta_entry->index_block + sblk->inode_table_start;
 +                       cur_offset = meta_entry->offset;
 +                       cur_data_block = meta_entry->data_block;
 +                       TRACE("get_meta_index: offset %d, meta->offset %d, "
-+                               "meta->entries %d\n", offset, meta->offset,
-+                               meta->entries);
++                               "meta->entries %d\n", offset, meta->offset, meta->entries);
 +                       TRACE("get_meta_index: index_block 0x%llx, offset 0x%x"
 +                               " data_block 0x%llx\n", cur_index_block,
 +                               cur_offset, cur_data_block);
@@ -1655,11 +1621,9 @@
 +                       int blocks = skip * SQUASHFS_META_INDEXES;
 +
 +                       while (blocks) {
-+                               int block = blocks > (SIZE >> 2) ? (SIZE >> 2) :
-+                                       blocks;
-+                               int res = read_block_index(inode->i_sb, block,
-+                                       block_list, &cur_index_block,
-+                                       &cur_offset);
++                               int block = blocks > (SIZE >> 2) ? (SIZE >> 2) : blocks;
++                               int res = read_block_index(inode->i_sb, block, block_list,
++                                       &cur_index_block, &cur_offset);
 +
 +                               if (res == -1)
 +                                       goto failed;
@@ -1706,15 +1670,14 @@
 +               block_list);
 +
 +       TRACE("read_blocklist: res %d, index %d, block_ptr 0x%llx, offset"
-+                      " 0x%x, block 0x%llx\n", res, index, block_ptr, offset,
-+                      block);
++                      " 0x%x, block 0x%llx\n", res, index, block_ptr, offset, block);
 +
 +       if(res == -1)
 +               goto failure;
 +
 +       index -= res;
 +
-+       while ( index ) {
++       while (index) {
 +               int blocks = index > (SIZE >> 2) ? (SIZE >> 2) : index;
 +               int res = read_block_index(inode->i_sb, blocks, block_list,
 +                       &block_ptr, &offset);
@@ -1724,8 +1687,7 @@
 +               index -= blocks;
 +       }
 +
-+       if (read_block_index(inode->i_sb, 1, block_list,
-+                       &block_ptr, &offset) == -1)
++       if (read_block_index(inode->i_sb, 1, block_list, &block_ptr, &offset) == -1)
 +               goto failure;
 +       *bsize = *((unsigned int *) block_list);
 +
@@ -1741,9 +1703,10 @@
 +       struct inode *inode = page->mapping->host;
 +       struct squashfs_sb_info *msblk = inode->i_sb->s_fs_info;
 +       struct squashfs_super_block *sblk = &msblk->sblk;
-+       unsigned char *block_list;
++       unsigned char *block_list = NULL;
 +       long long block;
-+       unsigned int bsize, i = 0, bytes = 0, byte_offset = 0;
++       unsigned int bsize, i;
++       int bytes;
 +       int index = page->index >> (sblk->block_log - PAGE_CACHE_SHIFT);
 +       void *pageaddr;
 +       struct squashfs_fragment_cache *fragment = NULL;
@@ -1752,64 +1715,65 @@
 +       int mask = (1 << (sblk->block_log - PAGE_CACHE_SHIFT)) - 1;
 +       int start_index = page->index & ~mask;
 +       int end_index = start_index | mask;
++       int file_end = i_size_read(inode) >> sblk->block_log;
++       int sparse = 0;
 +
 +       TRACE("Entered squashfs_readpage, page index %lx, start block %llx\n",
-+                                       page->index,
-+                                       SQUASHFS_I(inode)->start_block);
-+
-+       if (!(block_list = kmalloc(SIZE, GFP_KERNEL))) {
-+               ERROR("Failed to allocate block_list\n");
-+               goto skip_read;
-+       }
++                                       page->index, SQUASHFS_I(inode)->start_block);
 +
 +       if (page->index >= ((i_size_read(inode) + PAGE_CACHE_SIZE - 1) >>
 +                                       PAGE_CACHE_SHIFT))
-+               goto skip_read;
++               goto out;
 +
 +       if (SQUASHFS_I(inode)->u.s1.fragment_start_block == SQUASHFS_INVALID_BLK
-+                                       || index < (i_size_read(inode) >>
-+                                       sblk->block_log)) {
-+               if ((block = (msblk->read_blocklist)(inode, index, 1,
-+                                       block_list, NULL, &bsize)) == 0)
-+                       goto skip_read;
++                                       || index < file_end) {
++               block_list = kmalloc(SIZE, GFP_KERNEL);
++               if (block_list == NULL) {
++                       ERROR("Failed to allocate block_list\n");
++                       goto error_out;
++               }
++
++               block = (msblk->read_blocklist)(inode, index, 1, block_list, NULL, &bsize);
++               if (block == 0)
++                       goto error_out;
 +
-+               mutex_lock(&msblk->read_page_mutex);
++               if (bsize == 0) { /* hole */
++                       bytes = index == file_end ?
++                               (i_size_read(inode) & (sblk->block_size - 1)) : sblk->block_size;
++                       sparse = 1;
++               } else {
++                       mutex_lock(&msblk->read_page_mutex);
 +               
-+               if (!(bytes = squashfs_read_data(inode->i_sb, msblk->read_page,
-+                                       block, bsize, NULL, sblk->block_size))) {
-+                       ERROR("Unable to read page, block %llx, size %x\n", block,
-+                                       bsize);
-+                       mutex_unlock(&msblk->read_page_mutex);
-+                       goto skip_read;
++                       bytes = squashfs_read_data(inode->i_sb, msblk->read_page, block,
++                               bsize, NULL, sblk->block_size);
++
++                       if (bytes == 0) {
++                               ERROR("Unable to read page, block %llx, size %x\n", block, bsize);
++                               mutex_unlock(&msblk->read_page_mutex);
++                               goto error_out;
++                       }
 +               }
 +       } else {
-+               if ((fragment = get_cached_fragment(inode->i_sb,
-+                                       SQUASHFS_I(inode)->
-+                                       u.s1.fragment_start_block,
-+                                       SQUASHFS_I(inode)->u.s1.fragment_size))
-+                                       == NULL) {
++               fragment = get_cached_fragment(inode->i_sb,
++                                       SQUASHFS_I(inode)-> u.s1.fragment_start_block,
++                                       SQUASHFS_I(inode)->u.s1.fragment_size);
++
++               if (fragment == NULL) {
 +                       ERROR("Unable to read page, block %llx, size %x\n",
-+                                       SQUASHFS_I(inode)->
-+                                       u.s1.fragment_start_block,
-+                                       (int) SQUASHFS_I(inode)->
-+                                       u.s1.fragment_size);
-+                       goto skip_read;
++                                       SQUASHFS_I(inode)->u.s1.fragment_start_block,
++                                       (int) SQUASHFS_I(inode)->u.s1.fragment_size);
++                       goto error_out;
 +               }
-+               bytes = SQUASHFS_I(inode)->u.s1.fragment_offset +
-+                                       (i_size_read(inode) & (sblk->block_size
-+                                       - 1));
-+               byte_offset = SQUASHFS_I(inode)->u.s1.fragment_offset;
-+               data_ptr = fragment->data;
++               bytes = i_size_read(inode) & (sblk->block_size - 1);
++               data_ptr = fragment->data + SQUASHFS_I(inode)->u.s1.fragment_offset;
 +       }
 +
-+       for (i = start_index; i <= end_index && byte_offset < bytes;
-+                                       i++, byte_offset += PAGE_CACHE_SIZE) {
++       for (i = start_index; i <= end_index && bytes > 0; i++,
++                                               bytes -= PAGE_CACHE_SIZE, data_ptr += PAGE_CACHE_SIZE) {
 +               struct page *push_page;
-+               int avail = (bytes - byte_offset) > PAGE_CACHE_SIZE ?
-+                                       PAGE_CACHE_SIZE : bytes - byte_offset;
++               int avail = sparse ? 0 : min_t(unsigned int, bytes, PAGE_CACHE_SIZE);
 +
-+               TRACE("bytes %d, i %d, byte_offset %d, available_bytes %d\n",
-+                                       bytes, i, byte_offset, avail);
++               TRACE("bytes %d, i %d, available_bytes %d\n", bytes, i, avail);
 +
 +               push_page = (i == page->index) ? page :
 +                       grab_cache_page_nowait(page->mapping, i);
@@ -1821,7 +1785,7 @@
 +                       goto skip_page;
 +
 +               pageaddr = kmap_atomic(push_page, KM_USER0);
-+               memcpy(pageaddr, data_ptr + byte_offset, avail);
++               memcpy(pageaddr, data_ptr, avail);
 +               memset(pageaddr + avail, 0, PAGE_CACHE_SIZE - avail);
 +               kunmap_atomic(pageaddr, KM_USER0);
 +               flush_dcache_page(push_page);
@@ -1833,98 +1797,24 @@
 +       }
 +
 +       if (SQUASHFS_I(inode)->u.s1.fragment_start_block == SQUASHFS_INVALID_BLK
-+                                       || index < (i_size_read(inode) >>
-+                                       sblk->block_log))
-+               mutex_unlock(&msblk->read_page_mutex);
-+       else
++                                       || index < file_end) {
++               if (!sparse)
++                       mutex_unlock(&msblk->read_page_mutex);
++               kfree(block_list);
++       } else
 +               release_cached_fragment(msblk, fragment);
 +
-+       kfree(block_list);
-+       return 0;
-+
-+skip_read:
-+       pageaddr = kmap_atomic(page, KM_USER0);
-+       memset(pageaddr + bytes, 0, PAGE_CACHE_SIZE - bytes);
-+       kunmap_atomic(pageaddr, KM_USER0);
-+       flush_dcache_page(page);
-+       SetPageUptodate(page);
-+       unlock_page(page);
-+
-+       kfree(block_list);
 +       return 0;
-+}
-+
 +
-+static int squashfs_readpage4K(struct file *file, struct page *page)
-+{
-+       struct inode *inode = page->mapping->host;
-+       struct squashfs_sb_info *msblk = inode->i_sb->s_fs_info;
-+       struct squashfs_super_block *sblk = &msblk->sblk;
-+       unsigned char *block_list;
-+       long long block;
-+       unsigned int bsize, bytes = 0;
-+       void *pageaddr;
-+       
-+       TRACE("Entered squashfs_readpage4K, page index %lx, start block %llx\n",
-+                                       page->index,
-+                                       SQUASHFS_I(inode)->start_block);
-+
-+       if (page->index >= ((i_size_read(inode) + PAGE_CACHE_SIZE - 1) >>
-+                                       PAGE_CACHE_SHIFT)) {
-+               block_list = NULL;
-+               goto skip_read;
-+       }
-+
-+       if (!(block_list = kmalloc(SIZE, GFP_KERNEL))) {
-+               ERROR("Failed to allocate block_list\n");
-+               goto skip_read;
-+       }
-+
-+       if (SQUASHFS_I(inode)->u.s1.fragment_start_block == SQUASHFS_INVALID_BLK
-+                                       || page->index < (i_size_read(inode) >>
-+                                       sblk->block_log)) {
-+               block = (msblk->read_blocklist)(inode, page->index, 1,
-+                                       block_list, NULL, &bsize);
-+               if(block == 0)
-+                       goto skip_read;
-+
-+               mutex_lock(&msblk->read_page_mutex);
-+               bytes = squashfs_read_data(inode->i_sb, msblk->read_page, block,
-+                                       bsize, NULL, sblk->block_size);
-+               if (bytes) {
-+                       pageaddr = kmap_atomic(page, KM_USER0);
-+                       memcpy(pageaddr, msblk->read_page, bytes);
-+                       kunmap_atomic(pageaddr, KM_USER0);
-+               } else
-+                       ERROR("Unable to read page, block %llx, size %x\n",
-+                                       block, bsize);
-+               mutex_unlock(&msblk->read_page_mutex);
-+       } else {
-+               struct squashfs_fragment_cache *fragment =
-+                       get_cached_fragment(inode->i_sb,
-+                                       SQUASHFS_I(inode)->
-+                                       u.s1.fragment_start_block,
-+                                       SQUASHFS_I(inode)-> u.s1.fragment_size);
-+               if (fragment) {
-+                       bytes = i_size_read(inode) & (sblk->block_size - 1);
-+                       pageaddr = kmap_atomic(page, KM_USER0);
-+                       memcpy(pageaddr, fragment->data + SQUASHFS_I(inode)->
-+                                       u.s1.fragment_offset, bytes);
-+                       kunmap_atomic(pageaddr, KM_USER0);
-+                       release_cached_fragment(msblk, fragment);
-+               } else
-+                       ERROR("Unable to read page, block %llx, size %x\n",
-+                                       SQUASHFS_I(inode)->
-+                                       u.s1.fragment_start_block, (int)
-+                                       SQUASHFS_I(inode)-> u.s1.fragment_size);
-+       }
-+
-+skip_read:
++error_out:
++       SetPageError(page);
++out:
 +       pageaddr = kmap_atomic(page, KM_USER0);
-+       memset(pageaddr + bytes, 0, PAGE_CACHE_SIZE - bytes);
++       memset(pageaddr, 0, PAGE_CACHE_SIZE);
 +       kunmap_atomic(pageaddr, KM_USER0);
 +       flush_dcache_page(page);
-+       SetPageUptodate(page);
++       if (!PageError(page))
++               SetPageUptodate(page);
 +       unlock_page(page);
 +
 +       kfree(block_list);
@@ -1932,10 +1822,9 @@
 +}
 +
 +
-+static int get_dir_index_using_offset(struct super_block *s, long long 
-+                               *next_block, unsigned int *next_offset,
-+                               long long index_start,
-+                               unsigned int index_offset, int i_count,
++static int get_dir_index_using_offset(struct super_block *s,
++                               long long *next_block, unsigned int *next_offset,
++                               long long index_start, unsigned int index_offset, int i_count,
 +                               long long f_pos)
 +{
 +       struct squashfs_sb_info *msblk = s->s_fs_info;
@@ -1953,23 +1842,18 @@
 +       for (i = 0; i < i_count; i++) {
 +               if (msblk->swap) {
 +                       struct squashfs_dir_index sindex;
-+                       squashfs_get_cached_block(s, (char *) &sindex,
-+                                       index_start, index_offset,
-+                                       sizeof(sindex), &index_start,
-+                                       &index_offset);
++                       squashfs_get_cached_block(s, &sindex, index_start, index_offset,
++                                       sizeof(sindex), &index_start, &index_offset);
 +                       SQUASHFS_SWAP_DIR_INDEX(&index, &sindex);
 +               } else
-+                       squashfs_get_cached_block(s, (char *) &index,
-+                                       index_start, index_offset,
-+                                       sizeof(index), &index_start,
-+                                       &index_offset);
++                       squashfs_get_cached_block(s, &index, index_start, index_offset,
++                                       sizeof(index), &index_start, &index_offset);
 +
 +               if (index.index > f_pos)
 +                       break;
 +
 +               squashfs_get_cached_block(s, NULL, index_start, index_offset,
-+                                       index.size + 1, &index_start,
-+                                       &index_offset);
++                                       index.size + 1, &index_start, &index_offset);
 +
 +               length = index.index;
 +               *next_block = index.start_block + sblk->directory_table_start;
@@ -1982,10 +1866,9 @@
 +}
 +
 +
-+static int get_dir_index_using_name(struct super_block *s, long long
-+                               *next_block, unsigned int *next_offset,
-+                               long long index_start,
-+                               unsigned int index_offset, int i_count,
++static int get_dir_index_using_name(struct super_block *s,
++                               long long *next_block, unsigned int *next_offset,
++                               long long index_start, unsigned int index_offset, int i_count,
 +                               const char *name, int size)
 +{
 +       struct squashfs_sb_info *msblk = s->s_fs_info;
@@ -1996,8 +1879,9 @@
 +
 +       TRACE("Entered get_dir_index_using_name, i_count %d\n", i_count);
 +
-+       if (!(str = kmalloc(sizeof(struct squashfs_dir_index) +
-+               (SQUASHFS_NAME_LEN + 1) * 2, GFP_KERNEL))) {
++       str = kmalloc(sizeof(struct squashfs_dir_index) +
++               (SQUASHFS_NAME_LEN + 1) * 2, GFP_KERNEL);
++       if (str == NULL) {
 +               ERROR("Failed to allocate squashfs_dir_index\n");
 +               goto failure;
 +       }
@@ -2009,20 +1893,15 @@
 +       for (i = 0; i < i_count; i++) {
 +               if (msblk->swap) {
 +                       struct squashfs_dir_index sindex;
-+                       squashfs_get_cached_block(s, (char *) &sindex,
-+                                       index_start, index_offset,
-+                                       sizeof(sindex), &index_start,
-+                                       &index_offset);
++                       squashfs_get_cached_block(s, &sindex, index_start, index_offset,
++                               sizeof(sindex), &index_start, &index_offset);
 +                       SQUASHFS_SWAP_DIR_INDEX(index, &sindex);
 +               } else
-+                       squashfs_get_cached_block(s, (char *) index,
-+                                       index_start, index_offset,
-+                                       sizeof(struct squashfs_dir_index),
-+                                       &index_start, &index_offset);
++                       squashfs_get_cached_block(s, index, index_start, index_offset,
++                               sizeof(struct squashfs_dir_index), &index_start, &index_offset);
 +
-+               squashfs_get_cached_block(s, index->name, index_start,
-+                                       index_offset, index->size + 1,
-+                                       &index_start, &index_offset);
++               squashfs_get_cached_block(s, index->name, index_start, index_offset,
++                                       index->size + 1, &index_start, &index_offset);
 +
 +               index->name[index->size + 1] = '\0';
 +
@@ -2035,6 +1914,7 @@
 +
 +       *next_offset = (length + *next_offset) % SQUASHFS_METADATA_SIZE;
 +       kfree(str);
++
 +failure:
 +       return length + 3;
 +}
@@ -2047,15 +1927,15 @@
 +       struct squashfs_super_block *sblk = &msblk->sblk;
 +       long long next_block = SQUASHFS_I(i)->start_block +
 +               sblk->directory_table_start;
-+       int next_offset = SQUASHFS_I(i)->offset, length = 0,
-+               dir_count;
++       int next_offset = SQUASHFS_I(i)->offset, length = 0, dir_count;
 +       struct squashfs_dir_header dirh;
 +       struct squashfs_dir_entry *dire;
 +
 +       TRACE("Entered squashfs_readdir [%llx:%x]\n", next_block, next_offset);
 +
-+       if (!(dire = kmalloc(sizeof(struct squashfs_dir_entry) +
-+               SQUASHFS_NAME_LEN + 1, GFP_KERNEL))) {
++       dire = kmalloc(sizeof(struct squashfs_dir_entry) +
++               SQUASHFS_NAME_LEN + 1, GFP_KERNEL);
++       if (dire == NULL) {
 +               ERROR("Failed to allocate squashfs_dir_entry\n");
 +               goto finish;
 +       }
@@ -2075,14 +1955,12 @@
 +               }
 +               TRACE("Calling filldir(%x, %s, %d, %d, %d, %d)\n",
 +                               (unsigned int) dirent, name, size, (int)
-+                               file->f_pos, i_ino,
-+                               squashfs_filetype_table[1]);
++                               file->f_pos, i_ino, squashfs_filetype_table[1]);
 +
-+               if (filldir(dirent, name, size,
-+                               file->f_pos, i_ino,
++               if (filldir(dirent, name, size, file->f_pos, i_ino,
 +                               squashfs_filetype_table[1]) < 0) {
 +                               TRACE("Filldir returned less than 0\n");
-+                               goto finish;
++                       goto finish;
 +               }
 +               file->f_pos += size;
 +       }
@@ -2090,25 +1968,22 @@
 +       length = get_dir_index_using_offset(i->i_sb, &next_block, &next_offset,
 +                               SQUASHFS_I(i)->u.s2.directory_index_start,
 +                               SQUASHFS_I(i)->u.s2.directory_index_offset,
-+                               SQUASHFS_I(i)->u.s2.directory_index_count,
-+                               file->f_pos);
++                               SQUASHFS_I(i)->u.s2.directory_index_count, file->f_pos);
 +
 +       while (length < i_size_read(i)) {
 +               /* read directory header */
 +               if (msblk->swap) {
 +                       struct squashfs_dir_header sdirh;
 +                       
-+                       if (!squashfs_get_cached_block(i->i_sb, (char *) &sdirh,
-+                                       next_block, next_offset, sizeof(sdirh),
-+                                       &next_block, &next_offset))
++                       if (!squashfs_get_cached_block(i->i_sb, &sdirh, next_block,
++                                        next_offset, sizeof(sdirh), &next_block, &next_offset))
 +                               goto failed_read;
 +
 +                       length += sizeof(sdirh);
 +                       SQUASHFS_SWAP_DIR_HEADER(&dirh, &sdirh);
 +               } else {
-+                       if (!squashfs_get_cached_block(i->i_sb, (char *) &dirh,
-+                                       next_block, next_offset, sizeof(dirh),
-+                                       &next_block, &next_offset))
++                       if (!squashfs_get_cached_block(i->i_sb, &dirh, next_block,
++                                       next_offset, sizeof(dirh), &next_block, &next_offset))
 +                               goto failed_read;
 +
 +                       length += sizeof(dirh);
@@ -2118,28 +1993,22 @@
 +               while (dir_count--) {
 +                       if (msblk->swap) {
 +                               struct squashfs_dir_entry sdire;
-+                               if (!squashfs_get_cached_block(i->i_sb, (char *)
-+                                               &sdire, next_block, next_offset,
-+                                               sizeof(sdire), &next_block,
-+                                               &next_offset))
++                               if (!squashfs_get_cached_block(i->i_sb, &sdire, next_block,
++                                               next_offset, sizeof(sdire), &next_block, &next_offset))
 +                                       goto failed_read;
 +                               
 +                               length += sizeof(sdire);
 +                               SQUASHFS_SWAP_DIR_ENTRY(dire, &sdire);
 +                       } else {
-+                               if (!squashfs_get_cached_block(i->i_sb, (char *)
-+                                               dire, next_block, next_offset,
-+                                               sizeof(*dire), &next_block,
-+                                               &next_offset))
++                               if (!squashfs_get_cached_block(i->i_sb, dire, next_block,
++                                               next_offset, sizeof(*dire), &next_block, &next_offset))
 +                                       goto failed_read;
 +
 +                               length += sizeof(*dire);
 +                       }
 +
-+                       if (!squashfs_get_cached_block(i->i_sb, dire->name,
-+                                               next_block, next_offset,
-+                                               dire->size + 1, &next_block,
-+                                               &next_offset))
++                       if (!squashfs_get_cached_block(i->i_sb, dire->name, next_block,
++                                               next_offset, dire->size + 1, &next_block, &next_offset))
 +                               goto failed_read;
 +
 +                       length += dire->size + 1;
@@ -2150,17 +2019,14 @@
 +                       dire->name[dire->size + 1] = '\0';
 +
 +                       TRACE("Calling filldir(%x, %s, %d, %d, %x:%x, %d, %d)\n",
-+                                       (unsigned int) dirent, dire->name,
-+                                       dire->size + 1, (int) file->f_pos,
-+                                       dirh.start_block, dire->offset,
++                                       (unsigned int) dirent, dire->name, dire->size + 1,
++                                       (int) file->f_pos, dirh.start_block, dire->offset,
 +                                       dirh.inode_number + dire->inode_number,
 +                                       squashfs_filetype_table[dire->type]);
 +
-+                       if (filldir(dirent, dire->name, dire->size + 1,
-+                                       file->f_pos,
++                       if (filldir(dirent, dire->name, dire->size + 1, file->f_pos,
 +                                       dirh.inode_number + dire->inode_number,
-+                                       squashfs_filetype_table[dire->type])
-+                                       < 0) {
++                                       squashfs_filetype_table[dire->type]) < 0) {
 +                               TRACE("Filldir returned less than 0\n");
 +                               goto finish;
 +                       }
@@ -2190,15 +2056,15 @@
 +       struct squashfs_super_block *sblk = &msblk->sblk;
 +       long long next_block = SQUASHFS_I(i)->start_block +
 +                               sblk->directory_table_start;
-+       int next_offset = SQUASHFS_I(i)->offset, length = 0,
-+                               dir_count;
++       int next_offset = SQUASHFS_I(i)->offset, length = 0, dir_count;
 +       struct squashfs_dir_header dirh;
 +       struct squashfs_dir_entry *dire;
 +
 +       TRACE("Entered squashfs_lookup [%llx:%x]\n", next_block, next_offset);
 +
-+       if (!(dire = kmalloc(sizeof(struct squashfs_dir_entry) +
-+               SQUASHFS_NAME_LEN + 1, GFP_KERNEL))) {
++       dire = kmalloc(sizeof(struct squashfs_dir_entry) +
++               SQUASHFS_NAME_LEN + 1, GFP_KERNEL);
++       if (dire == NULL) {
 +               ERROR("Failed to allocate squashfs_dir_entry\n");
 +               goto exit_lookup;
 +       }
@@ -2209,24 +2075,21 @@
 +       length = get_dir_index_using_name(i->i_sb, &next_block, &next_offset,
 +                               SQUASHFS_I(i)->u.s2.directory_index_start,
 +                               SQUASHFS_I(i)->u.s2.directory_index_offset,
-+                               SQUASHFS_I(i)->u.s2.directory_index_count, name,
-+                               len);
++                               SQUASHFS_I(i)->u.s2.directory_index_count, name, len);
 +
 +       while (length < i_size_read(i)) {
 +               /* read directory header */
 +               if (msblk->swap) {
 +                       struct squashfs_dir_header sdirh;
-+                       if (!squashfs_get_cached_block(i->i_sb, (char *) &sdirh,
-+                                       next_block, next_offset, sizeof(sdirh),
-+                                       &next_block, &next_offset))
++                       if (!squashfs_get_cached_block(i->i_sb, &sdirh, next_block,
++                                        next_offset, sizeof(sdirh), &next_block, &next_offset))
 +                               goto failed_read;
 +
 +                       length += sizeof(sdirh);
 +                       SQUASHFS_SWAP_DIR_HEADER(&dirh, &sdirh);
 +               } else {
-+                       if (!squashfs_get_cached_block(i->i_sb, (char *) &dirh,
-+                                       next_block, next_offset, sizeof(dirh),
-+                                       &next_block, &next_offset))
++                       if (!squashfs_get_cached_block(i->i_sb, &dirh, next_block,
++                                       next_offset, sizeof(dirh), &next_block, &next_offset))
 +                               goto failed_read;
 +
 +                       length += sizeof(dirh);
@@ -2236,27 +2099,22 @@
 +               while (dir_count--) {
 +                       if (msblk->swap) {
 +                               struct squashfs_dir_entry sdire;
-+                               if (!squashfs_get_cached_block(i->i_sb, (char *)
-+                                               &sdire, next_block,next_offset,
-+                                               sizeof(sdire), &next_block,
-+                                               &next_offset))
++                               if (!squashfs_get_cached_block(i->i_sb, &sdire, next_block,
++                                               next_offset, sizeof(sdire), &next_block, &next_offset))
 +                                       goto failed_read;
 +                               
 +                               length += sizeof(sdire);
 +                               SQUASHFS_SWAP_DIR_ENTRY(dire, &sdire);
 +                       } else {
-+                               if (!squashfs_get_cached_block(i->i_sb, (char *)
-+                                               dire, next_block,next_offset,
-+                                               sizeof(*dire), &next_block,
-+                                               &next_offset))
++                               if (!squashfs_get_cached_block(i->i_sb, dire, next_block,
++                                               next_offset, sizeof(*dire), &next_block, &next_offset))
 +                                       goto failed_read;
 +
 +                               length += sizeof(*dire);
 +                       }
 +
-+                       if (!squashfs_get_cached_block(i->i_sb, dire->name,
-+                                       next_block, next_offset, dire->size + 1,
-+                                       &next_block, &next_offset))
++                       if (!squashfs_get_cached_block(i->i_sb, dire->name, next_block,
++                                       next_offset, dire->size + 1, &next_block, &next_offset))
 +                               goto failed_read;
 +
 +                       length += dire->size + 1;
@@ -2268,9 +2126,8 @@
 +                               squashfs_inode_t ino = SQUASHFS_MKINODE(dirh.start_block,
 +                                                               dire->offset);
 +
-+                               TRACE("calling squashfs_iget for directory "
-+                                       "entry %s, inode %x:%x, %d\n", name,
-+                                       dirh.start_block, dire->offset,
++                               TRACE("calling squashfs_iget for directory entry %s, inode"
++                                       "  %x:%x, %d\n", name, dirh.start_block, dire->offset,
 +                                       dirh.inode_number + dire->inode_number);
 +
 +                               inode = squashfs_iget(i->i_sb, ino, dirh.inode_number + dire->inode_number);
@@ -2308,16 +2165,15 @@
 +       if (s->s_fs_info) {
 +               struct squashfs_sb_info *sbi = s->s_fs_info;
 +               if (sbi->block_cache)
-+                       for (i = 0; i < SQUASHFS_CACHED_BLKS; i++)
-+                               if (sbi->block_cache[i].block !=
-+                                                       SQUASHFS_INVALID_BLK)
-+                                       kfree(sbi->block_cache[i].data);
++                       for (i = 0; i < squashfs_cached_blks; i++)
++                               if (sbi->block_cache[i].block != SQUASHFS_INVALID_BLK)
++                                       vfree(sbi->block_cache[i].data);
 +               if (sbi->fragment)
 +                       for (i = 0; i < SQUASHFS_CACHED_FRAGMENTS; i++) 
-+                               SQUASHFS_FREE(sbi->fragment[i].data);
++                               vfree(sbi->fragment[i].data);
 +               kfree(sbi->fragment);
 +               kfree(sbi->block_cache);
-+               kfree(sbi->read_page);
++               vfree(sbi->read_page);
 +               kfree(sbi->uid);
 +               kfree(sbi->fragment_index);
 +               kfree(sbi->fragment_index_2);
@@ -2330,8 +2186,7 @@
 +
 +
 +static int squashfs_get_sb(struct file_system_type *fs_type, int flags,
-+                               const char *dev_name, void *data,
-+                               struct vfsmount *mnt)
++                               const char *dev_name, void *data, struct vfsmount *mnt)
 +{
 +       return get_sb_bdev(fs_type, flags, dev_name, data, squashfs_fill_super,
 +                               mnt);
@@ -2344,10 +2199,11 @@
 +       if (err)
 +               goto out;
 +
-+       printk(KERN_INFO "squashfs: version 3.2-r2 (2007/01/15) "
++       printk(KERN_INFO "squashfs: version 3.3 (2007/10/31) "
 +               "Phillip Lougher\n");
 +
-+       if ((err = register_filesystem(&squashfs_fs_type)))
++       err = register_filesystem(&squashfs_fs_type);
++       if (err)
 +               destroy_inodecache();
 +
 +out:
@@ -2369,9 +2225,7 @@
 +{
 +       struct squashfs_inode_info *ei;
 +       ei = kmem_cache_alloc(squashfs_inode_cachep, GFP_KERNEL);
-+       if (!ei)
-+               return NULL;
-+       return &ei->vfs_inode;
++       return ei ? &ei->vfs_inode : NULL;
 +}
 +
 +
@@ -2381,22 +2235,19 @@
 +}
 +
 +
-+static void init_once(void * foo, struct kmem_cache * cachep, unsigned long flags)
++static void init_once(struct kmem_cache *cachep, void *foo)
 +{
 +       struct squashfs_inode_info *ei = foo;
 +
-+       if ((flags & (SLAB_CTOR_VERIFY|SLAB_CTOR_CONSTRUCTOR)) ==
-+                                                       SLAB_CTOR_CONSTRUCTOR)
-+               inode_init_once(&ei->vfs_inode);
++       inode_init_once(&ei->vfs_inode);
 +}
 + 
 +
 +static int __init init_inodecache(void)
 +{
 +       squashfs_inode_cachep = kmem_cache_create("squashfs_inode_cache",
-+            sizeof(struct squashfs_inode_info),
-+            0, SLAB_HWCACHE_ALIGN|SLAB_RECLAIM_ACCOUNT,
-+            init_once, NULL);
++           sizeof(struct squashfs_inode_info), 0,
++               SLAB_HWCACHE_ALIGN|SLAB_RECLAIM_ACCOUNT, init_once);
 +       if (squashfs_inode_cachep == NULL)
 +               return -ENOMEM;
 +       return 0;
@@ -2411,11 +2262,12 @@
 +
 +module_init(init_squashfs_fs);
 +module_exit(exit_squashfs_fs);
-+MODULE_DESCRIPTION("squashfs 3.2-r2, a compressed read-only filesystem");
-+MODULE_AUTHOR("Phillip Lougher <phillip@lougher.org.uk>");
++MODULE_DESCRIPTION("squashfs 3.2-r2-CVS, a compressed read-only filesystem");
++MODULE_AUTHOR("Phillip Lougher <phillip@lougher.demon.co.uk>");
 +MODULE_LICENSE("GPL");
---- /dev/null
-+++ linux-2.6.24-rc1/fs/squashfs/Makefile
+diff -x .gitignore -Nurp linux-2.6.24/fs/squashfs/Makefile linux-2.6.24-squashfs3.3/fs/squashfs/Makefile
+--- linux-2.6.24/fs/squashfs/Makefile   1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.24-squashfs3.3/fs/squashfs/Makefile       2005-11-20 14:31:00.000000000 +0000
 @@ -0,0 +1,7 @@
 +#
 +# Makefile for the linux squashfs routines.
@@ -2424,14 +2276,15 @@
 +obj-$(CONFIG_SQUASHFS) += squashfs.o
 +squashfs-y += inode.o
 +squashfs-y += squashfs2_0.o
---- /dev/null
-+++ linux-2.6.24-rc1/fs/squashfs/squashfs2_0.c
-@@ -0,0 +1,742 @@
+diff -x .gitignore -Nurp linux-2.6.24/fs/squashfs/squashfs2_0.c linux-2.6.24-squashfs3.3/fs/squashfs/squashfs2_0.c
+--- linux-2.6.24/fs/squashfs/squashfs2_0.c      1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.24-squashfs3.3/fs/squashfs/squashfs2_0.c  2007-10-25 00:43:59.000000000 +0100
+@@ -0,0 +1,740 @@
 +/*
 + * Squashfs - a compressed read only filesystem for Linux
 + *
 + * Copyright (c) 2002, 2003, 2004, 2005, 2006, 2007
-+ * Phillip Lougher <phillip@lougher.org.uk>
++ * Phillip Lougher <phillip@lougher.demon.co.uk>
 + *
 + * This program is free software; you can redistribute it and/or
 + * modify it under the terms of the GNU General Public License
@@ -2577,14 +2430,15 @@
 +       unsigned int block = SQUASHFS_INODE_BLK(inode) +
 +               sblk->inode_table_start;
 +       unsigned int offset = SQUASHFS_INODE_OFFSET(inode);
-+       unsigned int ino = i->i_ino;
++       unsigned int ino = SQUASHFS_MK_VFS_INODE(block -
++               sblk->inode_table_start, offset);
 +       long long next_block;
 +       unsigned int next_offset;
 +       union squashfs_inode_header_2 id, sid;
 +       struct squashfs_base_inode_header_2 *inodeb = &id.base,
 +                                         *sinodeb = &sid.base;
 +
-+       TRACE("Entered squashfs_iget\n");
++       TRACE("Entered squashfs_read_inode_2\n");
 +
 +       if (msblk->swap) {
 +               if (!squashfs_get_cached_block(s, (char *) sinodeb, block,
@@ -2641,10 +2495,7 @@
 +                       SQUASHFS_I(i)->start_block = inodep->start_block;
 +                       SQUASHFS_I(i)->u.s1.block_list_start = next_block;
 +                       SQUASHFS_I(i)->offset = next_offset;
-+                       if (sblk->block_size > 4096)
-+                               i->i_data.a_ops = &squashfs_aops;
-+                       else
-+                               i->i_data.a_ops = &squashfs_aops_4K;
++                       i->i_data.a_ops = &squashfs_aops;
 +
 +                       TRACE("File inode %x:%x, start_block %x, "
 +                                       "block_list_start %llx, offset %x\n",
@@ -3169,14 +3020,15 @@
 +
 +       return 1;
 +}
---- /dev/null
-+++ linux-2.6.24-rc1/fs/squashfs/squashfs.h
-@@ -0,0 +1,87 @@
+diff -x .gitignore -Nurp linux-2.6.24/fs/squashfs/squashfs.h linux-2.6.24-squashfs3.3/fs/squashfs/squashfs.h
+--- linux-2.6.24/fs/squashfs/squashfs.h 1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.24-squashfs3.3/fs/squashfs/squashfs.h     2007-08-19 04:23:16.000000000 +0100
+@@ -0,0 +1,86 @@
 +/*
 + * Squashfs - a compressed read only filesystem for Linux
 + *
 + * Copyright (c) 2002, 2003, 2004, 2005, 2006, 2007
-+ * Phillip Lougher <phillip@lougher.org.uk>
++ * Phillip Lougher <phillip@lougher.demon.co.uk>
 + *
 + * This program is free software; you can redistribute it and/or
 + * modify it under the terms of the GNU General Public License
@@ -3224,7 +3076,7 @@
 +extern unsigned int squashfs_read_data(struct super_block *s, char *buffer,
 +                               long long index, unsigned int length,
 +                               long long *next_index, int srclength);
-+extern int squashfs_get_cached_block(struct super_block *s, char *buffer,
++extern int squashfs_get_cached_block(struct super_block *s, void *buffer,
 +                               long long block, unsigned int offset,
 +                               int length, long long *next_block,
 +                               unsigned int *next_offset);
@@ -3236,7 +3088,6 @@
 +extern struct inode *squashfs_iget(struct super_block *s, squashfs_inode_t inode, unsigned int inode_number);
 +extern const struct address_space_operations squashfs_symlink_aops;
 +extern const struct address_space_operations squashfs_aops;
-+extern const struct address_space_operations squashfs_aops_4K;
 +extern struct inode_operations squashfs_dir_inode_ops;
 +#else
 +#define SQSH_EXTERN static
@@ -3259,9 +3110,10 @@
 +       return 0;
 +}
 +#endif
---- /dev/null
-+++ linux-2.6.24-rc1/include/linux/squashfs_fs.h
-@@ -0,0 +1,934 @@
+diff -x .gitignore -Nurp linux-2.6.24/include/linux/squashfs_fs.h linux-2.6.24-squashfs3.3/include/linux/squashfs_fs.h
+--- linux-2.6.24/include/linux/squashfs_fs.h    1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.24-squashfs3.3/include/linux/squashfs_fs.h        2007-11-01 03:50:57.000000000 +0000
+@@ -0,0 +1,935 @@
 +#ifndef SQUASHFS_FS
 +#define SQUASHFS_FS
 +
@@ -3269,7 +3121,7 @@
 + * Squashfs
 + *
 + * Copyright (c) 2002, 2003, 2004, 2005, 2006, 2007
-+ * Phillip Lougher <phillip@lougher.org.uk>
++ * Phillip Lougher <phillip@lougher.demon.co.uk>
 + *
 + * This program is free software; you can redistribute it and/or
 + * modify it under the terms of the GNU General Public License
@@ -3292,16 +3144,9 @@
 +#define CONFIG_SQUASHFS_2_0_COMPATIBILITY
 +#endif
 +
-+#ifdef CONFIG_SQUASHFS_VMALLOC
-+#define SQUASHFS_ALLOC(a)              vmalloc(a)
-+#define SQUASHFS_FREE(a)               vfree(a)
-+#else
-+#define SQUASHFS_ALLOC(a)              kmalloc(a, GFP_KERNEL)
-+#define SQUASHFS_FREE(a)               kfree(a)
-+#endif
 +#define SQUASHFS_CACHED_FRAGMENTS      CONFIG_SQUASHFS_FRAGMENT_CACHE_SIZE     
 +#define SQUASHFS_MAJOR                 3
-+#define SQUASHFS_MINOR                 0
++#define SQUASHFS_MINOR                 1
 +#define SQUASHFS_MAGIC                 0x73717368
 +#define SQUASHFS_MAGIC_SWAP            0x68737173
 +#define SQUASHFS_START                 0
@@ -3311,10 +3156,10 @@
 +#define SQUASHFS_METADATA_LOG          13
 +
 +/* default size of data blocks */
-+#define SQUASHFS_FILE_SIZE             65536
-+#define SQUASHFS_FILE_LOG              16
++#define SQUASHFS_FILE_SIZE             131072
++#define SQUASHFS_FILE_LOG              17
 +
-+#define SQUASHFS_FILE_MAX_SIZE         65536
++#define SQUASHFS_FILE_MAX_SIZE         1048576
 +
 +/* Max number of uids and gids */
 +#define SQUASHFS_UIDS                  256
@@ -3395,9 +3240,8 @@
 +
 +#define SQUASHFS_COMPRESSED_BIT_BLOCK          (1 << 24)
 +
-+#define SQUASHFS_COMPRESSED_SIZE_BLOCK(B)      (((B) & \
-+       ~SQUASHFS_COMPRESSED_BIT_BLOCK) ? (B) & \
-+       ~SQUASHFS_COMPRESSED_BIT_BLOCK : SQUASHFS_COMPRESSED_BIT_BLOCK)
++#define SQUASHFS_COMPRESSED_SIZE_BLOCK(B)      ((B) & \
++       ~SQUASHFS_COMPRESSED_BIT_BLOCK)
 +
 +#define SQUASHFS_COMPRESSED_BLOCK(B)   (!((B) & SQUASHFS_COMPRESSED_BIT_BLOCK))
 +
@@ -3893,6 +3737,15 @@
 +       unsigned int            start_block:24;
 +} __attribute__  ((packed));
 +
++union squashfs_inode_header_1 {
++       struct squashfs_base_inode_header_1     base;
++       struct squashfs_dev_inode_header_1      dev;
++       struct squashfs_symlink_inode_header_1  symlink;
++       struct squashfs_reg_inode_header_1      reg;
++       struct squashfs_dir_inode_header_1      dir;
++       struct squashfs_ipc_inode_header_1      ipc;
++};
++
 +#define SQUASHFS_SWAP_BASE_INODE_CORE_1(s, d, n) \
 +       SQUASHFS_MEMSET(s, d, n);\
 +       SQUASHFS_SWAP((s)->inode_type, d, 0, 4);\
@@ -4196,8 +4049,9 @@
 +
 +#endif
 +#endif
---- /dev/null
-+++ linux-2.6.24-rc1/include/linux/squashfs_fs_i.h
+diff -x .gitignore -Nurp linux-2.6.24/include/linux/squashfs_fs_i.h linux-2.6.24-squashfs3.3/include/linux/squashfs_fs_i.h
+--- linux-2.6.24/include/linux/squashfs_fs_i.h  1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.24-squashfs3.3/include/linux/squashfs_fs_i.h      2007-08-19 04:24:08.000000000 +0100
 @@ -0,0 +1,45 @@
 +#ifndef SQUASHFS_FS_I
 +#define SQUASHFS_FS_I
@@ -4205,7 +4059,7 @@
 + * Squashfs
 + *
 + * Copyright (c) 2002, 2003, 2004, 2005, 2006, 2007
-+ * Phillip Lougher <phillip@lougher.org.uk>
++ * Phillip Lougher <phillip@lougher.demon.co.uk>
 + *
 + * This program is free software; you can redistribute it and/or
 + * modify it under the terms of the GNU General Public License
@@ -4244,16 +4098,17 @@
 +       struct inode    vfs_inode;
 +};
 +#endif
---- /dev/null
-+++ linux-2.6.24-rc1/include/linux/squashfs_fs_sb.h
-@@ -0,0 +1,74 @@
+diff -x .gitignore -Nurp linux-2.6.24/include/linux/squashfs_fs_sb.h linux-2.6.24-squashfs3.3/include/linux/squashfs_fs_sb.h
+--- linux-2.6.24/include/linux/squashfs_fs_sb.h 1970-01-01 01:00:00.000000000 +0100
++++ linux-2.6.24-squashfs3.3/include/linux/squashfs_fs_sb.h     2007-08-19 04:24:26.000000000 +0100
+@@ -0,0 +1,76 @@
 +#ifndef SQUASHFS_FS_SB
 +#define SQUASHFS_FS_SB
 +/*
 + * Squashfs
 + *
 + * Copyright (c) 2002, 2003, 2004, 2005, 2006, 2007
-+ * Phillip Lougher <phillip@lougher.org.uk>
++ * Phillip Lougher <phillip@lougher.demon.co.uk>
 + *
 + * This program is free software; you can redistribute it and/or
 + * modify it under the terms of the GNU General Public License
@@ -4313,6 +4168,8 @@
 +       struct meta_index       *meta_index;
 +       z_stream                stream;
 +       long long               *inode_lookup_table;
++       int                     unused_cache_blks;
++       int                     unused_frag_blks;
 +       int                     (*read_inode)(struct inode *i,  squashfs_inode_t \
 +                               inode);
 +       long long               (*read_blocklist)(struct inode *inode, int \
@@ -4321,8 +4178,9 @@
 +       int                     (*read_fragment_index_table)(struct super_block *s);
 +};
 +#endif
---- linux-2.6.24-rc1.orig/init/do_mounts_rd.c
-+++ linux-2.6.24-rc1/init/do_mounts_rd.c
+diff -x .gitignore -Nurp linux-2.6.24/init/do_mounts_rd.c linux-2.6.24-squashfs3.3/init/do_mounts_rd.c
+--- linux-2.6.24/init/do_mounts_rd.c    2007-10-25 17:41:49.000000000 +0100
++++ linux-2.6.24-squashfs3.3/init/do_mounts_rd.c        2007-11-01 05:06:25.000000000 +0000
 @@ -5,6 +5,7 @@
  #include <linux/ext2_fs.h>
  #include <linux/romfs_fs.h>
@@ -4331,7 +4189,7 @@
  #include <linux/initrd.h>
  #include <linux/string.h>
  
-@@ -39,6 +40,7 @@
+@@ -39,6 +40,7 @@ static int __init crd_load(int in_fd, in
   * numbers could not be found.
   *
   * We currently check for the following magic numbers:
@@ -4339,7 +4197,7 @@
   *     minix
   *     ext2
   *     romfs
-@@ -53,6 +55,7 @@
+@@ -53,6 +55,7 @@ identify_ramdisk_image(int fd, int start
         struct ext2_super_block *ext2sb;
         struct romfs_super_block *romfsb;
         struct cramfs_super *cramfsb;
@@ -4347,7 +4205,7 @@
         int nblocks = -1;
         unsigned char *buf;
  
-@@ -64,6 +67,7 @@
+@@ -64,6 +67,7 @@ identify_ramdisk_image(int fd, int start
         ext2sb = (struct ext2_super_block *) buf;
         romfsb = (struct romfs_super_block *) buf;
         cramfsb = (struct cramfs_super *) buf;
@@ -4355,7 +4213,7 @@
         memset(buf, 0xe5, size);
  
         /*
-@@ -101,6 +105,18 @@
+@@ -101,6 +105,18 @@ identify_ramdisk_image(int fd, int start
                 goto done;
         }
  
diff --git a/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/uvesafb-0.1-rc3-2.6.22.patch b/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/uvesafb-0.1-rc3-2.6.22.patch
deleted file mode 100644
index 711375114f..0000000000
--- a/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/uvesafb-0.1-rc3-2.6.22.patch
+++ /dev/null
@@ -1,2590 +0,0 @@
----
- Documentation/fb/uvesafb.txt |  188 +++
- drivers/video/Kconfig        |   18 
- drivers/video/Makefile       |    1 
- drivers/video/modedb.c       |   28 
- drivers/video/uvesafb.c      | 2058 +++++++++++++++++++++++++++++++++++++++++++
- include/linux/connector.h    |    7 
- include/video/Kbuild         |    2 
- include/video/uvesafb.h      |  193 ++++
- 8 files changed, 2479 insertions(+), 16 deletions(-)
-
-Index: linux-2.6.22/Documentation/fb/uvesafb.txt
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/Documentation/fb/uvesafb.txt   2007-08-28 21:56:34.000000000 +0100
-@@ -0,0 +1,188 @@
-+
-+uvesafb - A Generic Driver for VBE2+ compliant video cards
-+==========================================================
-+
-+1. Requirements
-+---------------
-+
-+uvesafb should work with any video card that has a Video BIOS compliant
-+with the VBE 2.0 standard.
-+
-+Unlike other drivers, uvesafb makes use of a userspace helper called
-+v86d.  v86d is used to run the x86 Video BIOS code in a simulated and
-+controlled environment.  This allows uvesafb to function on arches other
-+than x86.  Check the v86d documentation for a list of currently supported
-+arches.
-+
-+v86d source code can be downloaded from the following website:
-+  http://dev.gentoo.org/~spock/projects/uvesafb
-+
-+Please refer to the v86d documentation for detailed configuration and
-+installation instructions.
-+
-+Note that the v86d userspace helper has to be available at all times in
-+order for uvesafb to work properly.  If you want to use uvesafb during
-+early boot, you will have to include v86d into an initramfs image, and
-+either compile it into the kernel or use it as an initrd.
-+
-+2. Caveats and limitations
-+--------------------------
-+
-+uvesafb is a _generic_ driver which supports a wide variety of video
-+cards, but which is ultimately limited by the Video BIOS interface.
-+The most important limitations are:
-+
-+- Lack of any type of acceleration.
-+- A strict and limited set of supported video modes.  Often the native
-+  or most optimal resolution/refresh rate for your setup will not work
-+  with uvesafb, simply because the Video BIOS doesn't support the
-+  video mode you want to use.  This can be especially painful with
-+  widescreen panels, where native video modes don't have the 4:3 aspect
-+  ratio, which is what most BIOS-es are limited to.
-+- Adjusting the refresh rate is only possible with a VBE 3.0 compliant
-+  Video BIOS.  Note that many nVidia Video BIOS-es claim to be VBE 3.0
-+  compliant, while they simply ignore any refresh rate settings.
-+
-+3. Configuration
-+----------------
-+
-+uvesafb can be compiled either as a module, or directly into the kernel.
-+In both cases it supports the same set of configuration options, which
-+are either given on the kernel command line or as module parameters, e.g.:
-+
-+ video=uvesafb:1024x768-32,mtrr:3,ywrap (compiled into the kernel)
-+
-+ # modprobe uvesafb mode=1024x768-32 mtrr=3 scroll=ywrap  (module)
-+
-+Accepted options:
-+
-+ypan    Enable display panning using the VESA protected mode
-+        interface.  The visible screen is just a window of the
-+        video memory, console scrolling is done by changing the
-+        start of the window.  Available on x86 only.
-+
-+ywrap   Same as ypan, but assumes your gfx board can wrap-around
-+        the video memory (i.e. starts reading from top if it
-+        reaches the end of video memory).  Faster than ypan.
-+               Available on x86 only.
-+
-+redraw  Scroll by redrawing the affected part of the screen, this
-+        is the safe (and slow) default.
-+
-+(If you're using uvesafb as a module, the above three options are
-+ used a parameter of the scroll option, e.g. scroll=ypan.)
-+
-+vgapal  Use the standard VGA registers for palette changes.
-+
-+pmipal  Use the protected mode interface for palette changes.
-+        This is the default if the protected mode interface is
-+        available.  Available on x86 only.
-+
-+mtrr:n  Setup memory type range registers for the framebuffer
-+        where n:
-+              0 - disabled (equivalent to nomtrr) (default)
-+              1 - uncachable
-+              2 - write-back
-+              3 - write-combining
-+              4 - write-through
-+
-+        If you see the following in dmesg, choose the type that matches
-+        the old one.  In this example, use "mtrr:2".
-+...
-+mtrr: type mismatch for e0000000,8000000 old: write-back new: write-combining
-+...
-+
-+nomtrr  Do not use memory type range registers.
-+
-+vremap:n
-+        Remap 'n' MiB of video RAM.  If 0 or not specified, remap memory
-+        according to video mode.
-+
-+vtotal:n
-+        If the video BIOS of your card incorrectly determines the total
-+        amount of video RAM, use this option to override the BIOS (in MiB).
-+
-+<mode>  The mode you want to set, in the standard modedb format.  Refer to
-+        modedb.txt for a detailed description.  When uvesafb is compiled as
-+        a module, the mode string should be provided as a value of the
-+        'mode' option.
-+
-+vbemode:x
-+        Force the use of VBE mode x.  The mode will only be set if it's
-+        found in the VBE-provided list of supported modes.
-+        NOTE: The mode number 'x' should be specified in VESA mode number
-+        notation, not the Linux kernel one (eg. 257 instead of 769).
-+        HINT: If you use this option because normal <mode> parameter does
-+        not work for you and you use a X server, you'll probably want to
-+        set the 'nocrtc' option to ensure that the video mode is properly
-+        restored after console <-> X switches.
-+
-+nocrtc  Do not use CRTC timings while setting the video mode.  This option
-+        has any effect only if the Video BIOS is VBE 3.0 compliant.  Use it
-+        if you have problems with modes set the standard way.  Note that
-+        using this option implies that any refresh rate adjustments will
-+        be ignored and the refresh rate will stay at your BIOS default (60 Hz).
-+
-+noedid  Do not try to fetch and use EDID-provided modes.
-+
-+noblank Disable hardware blanking.
-+
-+v86d:path
-+        Set path to the v86d executable. This option is only available as
-+        a module parameter, and not as a part of the video= string.  If you
-+        need to use it and have uvesafb built into the kernel, use
-+        uvesafb.v86d="path".
-+
-+Additionally, the following parameters may be provided.  They all override the
-+EDID-provided values and BIOS defaults.  Refer to your monitor's specs to get
-+the correct values for maxhf, maxvf and maxclk for your hardware.
-+
-+maxhf:n     Maximum horizontal frequency (in kHz).
-+maxvf:n     Maximum vertical frequency (in Hz).
-+maxclk:n    Maximum pixel clock (in MHz).
-+
-+4. The sysfs interface
-+----------------------
-+
-+uvesafb provides several sysfs nodes for configurable parameters and
-+additional information.
-+
-+Driver attributes:
-+
-+/sys/bus/platform/drivers/uvesafb
-+  - v86d (default: /sbin/v86d)
-+    Path to the v86d executable. v86d is started by uvesafb
-+    if an instance of the daemon isn't already running.
-+
-+Device attributes:
-+
-+/sys/bus/platform/drivers/uvesafb/uvesafb.0
-+  - nocrtc
-+    Use the default refresh rate (60 Hz) if set to 1.
-+
-+  - oem_product_name
-+  - oem_product_rev
-+  - oem_string
-+  - oem_vendor
-+    Information about the card and its maker.
-+
-+  - vbe_modes
-+    A list of video modes supported by the Video BIOS along with their
-+    VBE mode numbers in hex.
-+
-+  - vbe_version
-+    A BCD value indicating the implemented VBE standard.
-+
-+5. Miscellaneous
-+----------------
-+
-+Uvesafb will set a video mode with the default refresh rate and timings
-+from the Video BIOS if you set pixclock to 0 in fb_var_screeninfo.
-+
-+
-+--
-+ Michal Januszewski <spock@gentoo.org>
-+ Last updated: 2007-06-16
-+
-+ Documentation of the uvesafb options is loosely based on vesafb.txt.
-+
-Index: linux-2.6.22/drivers/video/Kconfig
-===================================================================
---- linux-2.6.22.orig/drivers/video/Kconfig     2007-08-28 21:56:33.000000000 +0100
-+++ linux-2.6.22/drivers/video/Kconfig  2007-08-28 21:56:34.000000000 +0100
-@@ -592,6 +592,24 @@ config FB_TGA
- 
-          Say Y if you have one of those.
- 
-+config FB_UVESA
-+       tristate "Userspace VESA VGA graphics support"
-+       depends on FB && CONNECTOR
-+       select FB_CFB_FILLRECT
-+       select FB_CFB_COPYAREA
-+       select FB_CFB_IMAGEBLIT
-+       select FB_MODE_HELPERS
-+       help
-+         This is the frame buffer driver for generic VBE 2.0 compliant
-+         graphic cards. It can also take advantage of VBE 3.0 features,
-+         such as refresh rate adjustment.
-+
-+         This driver generally provides more features than vesafb but
-+         requires a userspace helper application called 'v86d'. See
-+         <file:Documentation/fb/uvesafb.txt> for more information.
-+
-+         If unsure, say N.
-+
- config FB_VESA
-        bool "VESA VGA graphics support"
-        depends on (FB = y) && X86
-Index: linux-2.6.22/drivers/video/Makefile
-===================================================================
---- linux-2.6.22.orig/drivers/video/Makefile    2007-08-28 21:56:33.000000000 +0100
-+++ linux-2.6.22/drivers/video/Makefile 2007-08-28 21:56:34.000000000 +0100
-@@ -116,6 +116,7 @@ obj-$(CONFIG_FB_XILINX)           += xil
- obj-$(CONFIG_FB_OMAP)             += omap/
- 
- # Platform or fallback drivers go here
-+obj-$(CONFIG_FB_UVESA)            += uvesafb.o
- obj-$(CONFIG_FB_VESA)             += vesafb.o
- obj-$(CONFIG_FB_IMAC)             += imacfb.o
- obj-$(CONFIG_FB_VGA16)            += vga16fb.o
-Index: linux-2.6.22/drivers/video/modedb.c
-===================================================================
---- linux-2.6.22.orig/drivers/video/modedb.c    2007-08-28 21:54:13.000000000 +0100
-+++ linux-2.6.22/drivers/video/modedb.c 2007-08-28 21:56:34.000000000 +0100
-@@ -606,26 +606,29 @@ done:
-        DPRINTK("Trying specified video mode%s %ix%i\n",
-            refresh_specified ? "" : " (ignoring refresh rate)", xres, yres);
- 
--       diff = refresh;
-+       if (!refresh_specified)
-+               diff = 0;
-+       else
-+               diff = refresh;
-+
-        best = -1;
-        for (i = 0; i < dbsize; i++) {
--               if (name_matches(db[i], name, namelen) ||
--                   (res_specified && res_matches(db[i], xres, yres))) {
--                       if(!fb_try_mode(var, info, &db[i], bpp)) {
--                               if(!refresh_specified || db[i].refresh == refresh)
--                                       return 1;
--                               else {
--                                       if(diff > abs(db[i].refresh - refresh)) {
--                                               diff = abs(db[i].refresh - refresh);
--                                               best = i;
--                                       }
-+               if ((name_matches(db[i], name, namelen) ||
-+                   (res_specified && res_matches(db[i], xres, yres))) &&
-+                   !fb_try_mode(var, info, &db[i], bpp)) {
-+                       if (refresh_specified && db[i].refresh == refresh) {
-+                               return 1;
-+                       } else {
-+                               if (diff < db[i].refresh) {
-+                                       diff = db[i].refresh;
-+                                       best = i;
-                                }
-                        }
-                }
-        }
-        if (best != -1) {
-                fb_try_mode(var, info, &db[best], bpp);
--               return 2;
-+               return (refresh_specified) ? 2 : 1;
-        }
- 
-        diff = xres + yres;
-@@ -938,6 +941,7 @@ void fb_destroy_modelist(struct list_hea
-                kfree(pos);
-        }
- }
-+EXPORT_SYMBOL_GPL(fb_destroy_modelist);
- 
- /**
-  * fb_videomode_to_modelist: convert mode array to mode list
-Index: linux-2.6.22/drivers/video/uvesafb.c
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/video/uvesafb.c        2007-08-28 21:56:34.000000000 +0100
-@@ -0,0 +1,2058 @@
-+/*
-+ * A framebuffer driver for VBE 2.0+ compliant video cards
-+ *
-+ * (c) 2007 Michal Januszewski <spock@gentoo.org>
-+ *     Loosely based upon the vesafb driver.
-+ *
-+ */
-+#include <linux/init.h>
-+#include <linux/module.h>
-+#include <linux/moduleparam.h>
-+#include <linux/skbuff.h>
-+#include <linux/timer.h>
-+#include <linux/completion.h>
-+#include <linux/connector.h>
-+#include <linux/random.h>
-+#include <linux/platform_device.h>
-+#include <linux/limits.h>
-+#include <linux/fb.h>
-+#include <linux/io.h>
-+#include <linux/mutex.h>
-+#include <video/edid.h>
-+#include <video/vga.h>
-+#include <video/uvesafb.h>
-+#ifdef CONFIG_MTRR
-+#include <asm/mtrr.h>
-+#endif
-+#include "edid.h"
-+
-+static struct cb_id uvesafb_cn_id = {
-+       .idx = CN_IDX_V86D,
-+       .val = CN_VAL_V86D_UVESAFB
-+};
-+static char v86d_path[PATH_MAX] = "/sbin/v86d";
-+static char v86d_started;      /* has v86d been started by uvesafb? */
-+
-+static struct fb_fix_screeninfo uvesafb_fix __devinitdata = {
-+       .id     = "VESA VGA",
-+       .type   = FB_TYPE_PACKED_PIXELS,
-+       .accel  = FB_ACCEL_NONE,
-+       .visual = FB_VISUAL_TRUECOLOR,
-+};
-+
-+static int mtrr                __devinitdata = 3; /* enable mtrr by default */
-+static int blank       __devinitdata = 1; /* enable blanking by default */
-+static int ypan                __devinitdata = 1; /* 0: scroll, 1: ypan, 2: ywrap */
-+static int pmi_setpal  __devinitdata = 1; /* use PMI for palette changes */
-+static int nocrtc      __devinitdata; /* ignore CRTC settings */
-+static int noedid      __devinitdata; /* don't try DDC transfers */
-+static int vram_remap  __devinitdata; /* set amt. of memory to be used */
-+static int vram_total  __devinitdata; /* set total amount of memory */
-+static u16 maxclk      __devinitdata; /* maximum pixel clock */
-+static u16 maxvf       __devinitdata; /* maximum vertical frequency */
-+static u16 maxhf       __devinitdata; /* maximum horizontal frequency */
-+static u16 vbemode     __devinitdata; /* force use of a specific VBE mode */
-+static char *mode_option __devinitdata;
-+
-+static struct uvesafb_ktask *uvfb_tasks[UVESAFB_TASKS_MAX];
-+static DEFINE_MUTEX(uvfb_lock);
-+
-+/*
-+ * A handler for replies from userspace.
-+ *
-+ * Make sure each message passes consistency checks and if it does,
-+ * find the kernel part of the task struct, copy the registers and
-+ * the buffer contents and then complete the task.
-+ */
-+static void uvesafb_cn_callback(void *data)
-+{
-+       struct cn_msg *msg = data;
-+       struct uvesafb_task *utask;
-+       struct uvesafb_ktask *task;
-+
-+       if (msg->seq >= UVESAFB_TASKS_MAX)
-+               return;
-+
-+       mutex_lock(&uvfb_lock);
-+       task = uvfb_tasks[msg->seq];
-+
-+       if (!task || msg->ack != task->ack) {
-+               mutex_unlock(&uvfb_lock);
-+               return;
-+       }
-+
-+       utask = (struct uvesafb_task *)msg->data;
-+
-+       /* Sanity checks for the buffer length. */
-+       if (task->t.buf_len < utask->buf_len ||
-+           utask->buf_len > msg->len - sizeof(*utask)) {
-+               mutex_unlock(&uvfb_lock);
-+               return;
-+       }
-+
-+       uvfb_tasks[msg->seq] = NULL;
-+       mutex_unlock(&uvfb_lock);
-+
-+       memcpy(&task->t, utask, sizeof(*utask));
-+
-+       if (task->t.buf_len && task->buf)
-+               memcpy(task->buf, utask + 1, task->t.buf_len);
-+
-+       complete(task->done);
-+       return;
-+}
-+
-+static int uvesafb_helper_start(void)
-+{
-+       char *envp[] = {
-+               "HOME=/",
-+               "PATH=/sbin:/bin",
-+               NULL,
-+       };
-+
-+       char *argv[] = {
-+               v86d_path,
-+               NULL,
-+       };
-+
-+       return call_usermodehelper(v86d_path, argv, envp, 1);
-+}
-+
-+/*
-+ * Execute a uvesafb task.
-+ *
-+ * Returns 0 if the task is executed successfully.
-+ *
-+ * A message sent to the userspace consists of the uvesafb_task
-+ * struct and (optionally) a buffer. The uvesafb_task struct is
-+ * a simplified version of uvesafb_ktask (its kernel counterpart)
-+ * containing only the register values, flags and the length of
-+ * the buffer.
-+ *
-+ * Each message is assigned a sequence number (increased linearly)
-+ * and a random ack number. The sequence number is used as a key
-+ * for the uvfb_tasks array which holds pointers to uvesafb_ktask
-+ * structs for all requests.
-+ */
-+static int uvesafb_exec(struct uvesafb_ktask *task)
-+{
-+       static int seq;
-+       struct cn_msg *m;
-+       int err;
-+       int len = sizeof(task->t) + task->t.buf_len;
-+
-+       /*
-+        * Check whether the message isn't longer than the maximum
-+        * allowed by connector.
-+        */
-+       if (sizeof(*m) + len > CONNECTOR_MAX_MSG_SIZE) {
-+               printk(KERN_WARNING "uvesafb: message too long (%d), "
-+                       "can't execute task\n", (int)(sizeof(*m) + len));
-+               return -E2BIG;
-+       }
-+
-+       m = kzalloc(sizeof(*m) + len, GFP_KERNEL);
-+       if (!m)
-+               return -ENOMEM;
-+
-+       init_completion(task->done);
-+
-+       memcpy(&m->id, &uvesafb_cn_id, sizeof(m->id));
-+       m->seq = seq;
-+       m->len = len;
-+       m->ack = random32();
-+
-+       /* uvesafb_task structure */
-+       memcpy(m + 1, &task->t, sizeof(task->t));
-+
-+       /* Buffer */
-+       memcpy((u8 *)(m + 1) + sizeof(task->t), task->buf, task->t.buf_len);
-+
-+       /*
-+        * Save the message ack number so that we can find the kernel
-+        * part of this task when a reply is received from userspace.
-+        */
-+       task->ack = m->ack;
-+
-+       mutex_lock(&uvfb_lock);
-+
-+       /* If all slots are taken -- bail out. */
-+       if (uvfb_tasks[seq]) {
-+               mutex_unlock(&uvfb_lock);
-+               return -EBUSY;
-+       }
-+
-+       /* Save a pointer to the kernel part of the task struct. */
-+       uvfb_tasks[seq] = task;
-+       mutex_unlock(&uvfb_lock);
-+
-+       err = cn_netlink_send(m, 0, gfp_any());
-+       if (err == -ESRCH) {
-+               /*
-+                * Try to start the userspace helper if sending
-+                * the request failed the first time.
-+                */
-+               err = uvesafb_helper_start();
-+               if (err) {
-+                       printk(KERN_ERR "uvesafb: failed to execute %s\n",
-+                                       v86d_path);
-+                       printk(KERN_ERR "uvesafb: make sure that the v86d "
-+                                       "helper is installed and executable\n");
-+               } else {
-+                       v86d_started = 1;
-+                       err = cn_netlink_send(m, 0, gfp_any());
-+               }
-+       }
-+       kfree(m);
-+
-+       if (!err && !(task->t.flags & TF_EXIT))
-+               err = !wait_for_completion_timeout(task->done,
-+                               msecs_to_jiffies(UVESAFB_TIMEOUT));
-+
-+       mutex_lock(&uvfb_lock);
-+       uvfb_tasks[seq] = NULL;
-+       mutex_unlock(&uvfb_lock);
-+
-+       seq++;
-+       if (seq >= UVESAFB_TASKS_MAX)
-+               seq = 0;
-+
-+       return err;
-+}
-+
-+/*
-+ * Free a uvesafb_ktask struct.
-+ */
-+static void uvesafb_free(struct uvesafb_ktask *task)
-+{
-+       if (task) {
-+               if (task->done)
-+                       kfree(task->done);
-+               kfree(task);
-+       }
-+}
-+
-+/*
-+ * Prepare a uvesafb_ktask struct to be used again.
-+ */
-+static void uvesafb_reset(struct uvesafb_ktask *task)
-+{
-+       struct completion *cpl = task->done;
-+
-+       memset(task, 0, sizeof(*task));
-+       task->done = cpl;
-+}
-+
-+/*
-+ * Allocate and prepare a uvesafb_ktask struct.
-+ */
-+static struct uvesafb_ktask *uvesafb_prep(void)
-+{
-+       struct uvesafb_ktask *task;
-+
-+       task = kzalloc(sizeof(*task), GFP_KERNEL);
-+       if (task) {
-+               task->done = kzalloc(sizeof(*task->done), GFP_KERNEL);
-+               if (!task->done) {
-+                       kfree(task);
-+                       task = NULL;
-+               }
-+       }
-+       return task;
-+}
-+
-+static void uvesafb_setup_var(struct fb_var_screeninfo *var,
-+               struct fb_info *info, struct vbe_mode_ib *mode)
-+{
-+       struct uvesafb_par *par = info->par;
-+
-+       var->vmode = FB_VMODE_NONINTERLACED;
-+       var->sync = FB_SYNC_VERT_HIGH_ACT;
-+
-+       var->xres = mode->x_res;
-+       var->yres = mode->y_res;
-+       var->xres_virtual = mode->x_res;
-+       var->yres_virtual = (par->ypan) ?
-+                       info->fix.smem_len / mode->bytes_per_scan_line :
-+                       mode->y_res;
-+       var->xoffset = 0;
-+       var->yoffset = 0;
-+       var->bits_per_pixel = mode->bits_per_pixel;
-+
-+       if (var->bits_per_pixel == 15)
-+               var->bits_per_pixel = 16;
-+
-+       if (var->bits_per_pixel > 8) {
-+               var->red.offset    = mode->red_off;
-+               var->red.length    = mode->red_len;
-+               var->green.offset  = mode->green_off;
-+               var->green.length  = mode->green_len;
-+               var->blue.offset   = mode->blue_off;
-+               var->blue.length   = mode->blue_len;
-+               var->transp.offset = mode->rsvd_off;
-+               var->transp.length = mode->rsvd_len;
-+       } else {
-+               var->red.offset    = 0;
-+               var->green.offset  = 0;
-+               var->blue.offset   = 0;
-+               var->transp.offset = 0;
-+
-+               /*
-+                * We're assuming that we can switch the DAC to 8 bits. If
-+                * this proves to be incorrect, we'll update the fields
-+                * later in set_par().
-+                */
-+               if (par->vbe_ib.capabilities & VBE_CAP_CAN_SWITCH_DAC) {
-+                       var->red.length    = 8;
-+                       var->green.length  = 8;
-+                       var->blue.length   = 8;
-+                       var->transp.length = 0;
-+               } else {
-+                       var->red.length    = 6;
-+                       var->green.length  = 6;
-+                       var->blue.length   = 6;
-+                       var->transp.length = 0;
-+               }
-+       }
-+}
-+
-+static int uvesafb_vbe_find_mode(struct uvesafb_par *par,
-+               int xres, int yres, int depth, unsigned char flags)
-+{
-+       int i, match = -1, h = 0, d = 0x7fffffff;
-+
-+       for (i = 0; i < par->vbe_modes_cnt; i++) {
-+               h = abs(par->vbe_modes[i].x_res - xres) +
-+                   abs(par->vbe_modes[i].y_res - yres) +
-+                   abs(depth - par->vbe_modes[i].depth);
-+
-+               /*
-+                * We have an exact match in terms of resolution
-+                * and depth.
-+                */
-+               if (h == 0)
-+                       return i;
-+
-+               if (h < d || (h == d && par->vbe_modes[i].depth > depth)) {
-+                       d = h;
-+                       match = i;
-+               }
-+       }
-+       i = 1;
-+
-+       if (flags & UVESAFB_EXACT_DEPTH &&
-+                       par->vbe_modes[match].depth != depth)
-+               i = 0;
-+
-+       if (flags & UVESAFB_EXACT_RES && d > 24)
-+               i = 0;
-+
-+       if (i != 0)
-+               return match;
-+       else
-+               return -1;
-+}
-+
-+static u8 *uvesafb_vbe_state_save(struct uvesafb_par *par)
-+{
-+       struct uvesafb_ktask *task;
-+       u8 *state;
-+       int err;
-+
-+       if (!par->vbe_state_size)
-+               return NULL;
-+
-+       state = kmalloc(par->vbe_state_size, GFP_KERNEL);
-+       if (!state)
-+               return NULL;
-+
-+       task = uvesafb_prep();
-+       if (!task) {
-+               kfree(state);
-+               return NULL;
-+       }
-+
-+       task->t.regs.eax = 0x4f04;
-+       task->t.regs.ecx = 0x000f;
-+       task->t.regs.edx = 0x0001;
-+       task->t.flags = TF_BUF_RET | TF_BUF_ESBX;
-+       task->t.buf_len = par->vbe_state_size;
-+       task->buf = state;
-+       err = uvesafb_exec(task);
-+
-+       if (err || (task->t.regs.eax & 0xffff) != 0x004f) {
-+               printk(KERN_WARNING "uvesafb: VBE get state call "
-+                               "failed (eax=0x%x, err=%d)\n",
-+                               task->t.regs.eax, err);
-+               kfree(state);
-+               state = NULL;
-+       }
-+
-+       uvesafb_free(task);
-+       return state;
-+}
-+
-+static void uvesafb_vbe_state_restore(struct uvesafb_par *par, u8 *state_buf)
-+{
-+       struct uvesafb_ktask *task;
-+       int err;
-+
-+       if (!state_buf)
-+               return;
-+
-+       task = uvesafb_prep();
-+       if (!task)
-+               return;
-+
-+       task->t.regs.eax = 0x4f04;
-+       task->t.regs.ecx = 0x000f;
-+       task->t.regs.edx = 0x0002;
-+       task->t.buf_len = par->vbe_state_size;
-+       task->t.flags = TF_BUF_ESBX;
-+       task->buf = state_buf;
-+
-+       err = uvesafb_exec(task);
-+       if (err || (task->t.regs.eax & 0xffff) != 0x004f)
-+               printk(KERN_WARNING "uvesafb: VBE state restore call "
-+                               "failed (eax=0x%x, err=%d)\n",
-+                               task->t.regs.eax, err);
-+
-+       uvesafb_free(task);
-+}
-+
-+static int __devinit uvesafb_vbe_getinfo(struct uvesafb_ktask *task,
-+               struct uvesafb_par *par)
-+{
-+       int err;
-+
-+       task->t.regs.eax = 0x4f00;
-+       task->t.flags = TF_VBEIB;
-+       task->t.buf_len = sizeof(struct vbe_ib);
-+       task->buf = &par->vbe_ib;
-+       strncpy(par->vbe_ib.vbe_signature, "VBE2", 4);
-+
-+       err = uvesafb_exec(task);
-+       if (err || (task->t.regs.eax & 0xffff) != 0x004f) {
-+               printk(KERN_ERR "uvesafb: Getting VBE info block failed "
-+                               "(eax=0x%x, err=%d)\n", (u32)task->t.regs.eax,
-+                               err);
-+               return -EINVAL;
-+       }
-+
-+       if (par->vbe_ib.vbe_version < 0x0200) {
-+               printk(KERN_ERR "uvesafb: Sorry, pre-VBE 2.0 cards are "
-+                               "not supported.\n");
-+               return -EINVAL;
-+       }
-+
-+       if (!par->vbe_ib.mode_list_ptr) {
-+               printk(KERN_ERR "uvesafb: Missing mode list!\n");
-+               return -EINVAL;
-+       }
-+
-+       printk(KERN_INFO "uvesafb: ");
-+
-+       /*
-+        * Convert string pointers and the mode list pointer into
-+        * usable addresses. Print informational messages about the
-+        * video adapter and its vendor.
-+        */
-+       if (par->vbe_ib.oem_vendor_name_ptr)
-+               printk("%s, ",
-+                       ((char *)task->buf) + par->vbe_ib.oem_vendor_name_ptr);
-+
-+       if (par->vbe_ib.oem_product_name_ptr)
-+               printk("%s, ",
-+                       ((char *)task->buf) + par->vbe_ib.oem_product_name_ptr);
-+
-+       if (par->vbe_ib.oem_product_rev_ptr)
-+               printk("%s, ",
-+                       ((char *)task->buf) + par->vbe_ib.oem_product_rev_ptr);
-+
-+       if (par->vbe_ib.oem_string_ptr)
-+               printk("OEM: %s, ",
-+                       ((char *)task->buf) + par->vbe_ib.oem_string_ptr);
-+
-+       printk("VBE v%d.%d\n", ((par->vbe_ib.vbe_version & 0xff00) >> 8),
-+                       par->vbe_ib.vbe_version & 0xff);
-+
-+       return 0;
-+}
-+
-+static int __devinit uvesafb_vbe_getmodes(struct uvesafb_ktask *task,
-+               struct uvesafb_par *par)
-+{
-+       int off = 0, err;
-+       u16 *mode;
-+
-+       par->vbe_modes_cnt = 0;
-+
-+       /* Count available modes. */
-+       mode = (u16 *) (((u8 *)&par->vbe_ib) + par->vbe_ib.mode_list_ptr);
-+       while (*mode != 0xffff) {
-+               par->vbe_modes_cnt++;
-+               mode++;
-+       }
-+
-+       par->vbe_modes = kzalloc(sizeof(struct vbe_mode_ib) *
-+                               par->vbe_modes_cnt, GFP_KERNEL);
-+       if (!par->vbe_modes)
-+               return -ENOMEM;
-+
-+       /* Get info about all available modes. */
-+       mode = (u16 *) (((u8 *)&par->vbe_ib) + par->vbe_ib.mode_list_ptr);
-+       while (*mode != 0xffff) {
-+               struct vbe_mode_ib *mib;
-+
-+               uvesafb_reset(task);
-+               task->t.regs.eax = 0x4f01;
-+               task->t.regs.ecx = (u32) *mode;
-+               task->t.flags = TF_BUF_RET | TF_BUF_ESDI;
-+               task->t.buf_len = sizeof(struct vbe_mode_ib);
-+               task->buf = par->vbe_modes + off;
-+
-+               err = uvesafb_exec(task);
-+               if (err || (task->t.regs.eax & 0xffff) != 0x004f) {
-+                       printk(KERN_ERR "uvesafb: Getting mode info block "
-+                               "for mode 0x%x failed (eax=0x%x, err=%d)\n",
-+                               *mode, (u32)task->t.regs.eax, err);
-+                       return -EINVAL;
-+               }
-+
-+               mib = task->buf;
-+               mib->mode_id = *mode;
-+
-+               /*
-+                * We only want modes that are supported with the current
-+                * hardware configuration, color, graphics and that have
-+                * support for the LFB.
-+                */
-+               if ((mib->mode_attr & VBE_MODE_MASK) == VBE_MODE_MASK &&
-+                                mib->bits_per_pixel >= 8)
-+                       off++;
-+               else
-+                       par->vbe_modes_cnt--;
-+
-+               mode++;
-+               mib->depth = mib->red_len + mib->green_len + mib->blue_len;
-+
-+               /*
-+                * Handle 8bpp modes and modes with broken color component
-+                * lengths.
-+                */
-+               if (mib->depth == 0 || (mib->depth == 24 &&
-+                                       mib->bits_per_pixel == 32))
-+                       mib->depth = mib->bits_per_pixel;
-+       }
-+
-+       return 0;
-+}
-+
-+/*
-+ * The Protected Mode Interface is 32-bit x86 code, so we only run it on
-+ * x86 and not x86_64.
-+ */
-+#ifdef CONFIG_X86_32
-+static int __devinit uvesafb_vbe_getpmi(struct uvesafb_ktask *task,
-+               struct uvesafb_par *par)
-+{
-+       int i, err;
-+
-+       uvesafb_reset(task);
-+       task->t.regs.eax = 0x4f0a;
-+       task->t.regs.ebx = 0x0;
-+       err = uvesafb_exec(task);
-+
-+       if ((task->t.regs.eax & 0xffff) != 0x4f || task->t.regs.es < 0xc000) {
-+               par->pmi_setpal = par->ypan = 0;
-+       } else {
-+               par->pmi_base = (u16 *)phys_to_virt(((u32)task->t.regs.es << 4)
-+                                               + task->t.regs.edi);
-+               par->pmi_start = (u8 *)par->pmi_base + par->pmi_base[1];
-+               par->pmi_pal = (u8 *)par->pmi_base + par->pmi_base[2];
-+               printk(KERN_INFO "uvesafb: protected mode interface info at "
-+                                "%04x:%04x\n",
-+                                (u16)task->t.regs.es, (u16)task->t.regs.edi);
-+               printk(KERN_INFO "uvesafb: pmi: set display start = %p, "
-+                                "set palette = %p\n", par->pmi_start,
-+                                par->pmi_pal);
-+
-+               if (par->pmi_base[3]) {
-+                       printk(KERN_INFO "uvesafb: pmi: ports = ");
-+                       for (i = par->pmi_base[3]/2;
-+                                       par->pmi_base[i] != 0xffff; i++)
-+                               printk("%x ", par->pmi_base[i]);
-+                       printk("\n");
-+
-+                       if (par->pmi_base[i] != 0xffff) {
-+                               printk(KERN_INFO "uvesafb: can't handle memory"
-+                                                " requests, pmi disabled\n");
-+                               par->ypan = par->pmi_setpal = 0;
-+                       }
-+               }
-+       }
-+       return 0;
-+}
-+#endif /* CONFIG_X86_32 */
-+
-+/*
-+ * Check whether a video mode is supported by the Video BIOS and is
-+ * compatible with the monitor limits.
-+ */
-+static int __devinit uvesafb_is_valid_mode(struct fb_videomode *mode,
-+               struct fb_info *info)
-+{
-+       if (info->monspecs.gtf) {
-+               fb_videomode_to_var(&info->var, mode);
-+               if (fb_validate_mode(&info->var, info))
-+                       return 0;
-+       }
-+
-+       if (uvesafb_vbe_find_mode(info->par, mode->xres, mode->yres, 8,
-+                               UVESAFB_EXACT_RES) == -1)
-+               return 0;
-+
-+       return 1;
-+}
-+
-+static int __devinit uvesafb_vbe_getedid(struct uvesafb_ktask *task,
-+               struct fb_info *info)
-+{
-+       struct uvesafb_par *par = info->par;
-+       int err = 0;
-+
-+       if (noedid || par->vbe_ib.vbe_version < 0x0300)
-+               return -EINVAL;
-+
-+       task->t.regs.eax = 0x4f15;
-+       task->t.regs.ebx = 0;
-+       task->t.regs.ecx = 0;
-+       task->t.buf_len = 0;
-+       task->t.flags = 0;
-+
-+       err = uvesafb_exec(task);
-+
-+       if ((task->t.regs.eax & 0xffff) != 0x004f || err)
-+               return -EINVAL;
-+
-+       if ((task->t.regs.ebx & 0x3) == 3) {
-+               printk(KERN_INFO "uvesafb: VBIOS/hardware supports both "
-+                                "DDC1 and DDC2 transfers\n");
-+       } else if ((task->t.regs.ebx & 0x3) == 2) {
-+               printk(KERN_INFO "uvesafb: VBIOS/hardware supports DDC2 "
-+                                "transfers\n");
-+       } else if ((task->t.regs.ebx & 0x3) == 1) {
-+               printk(KERN_INFO "uvesafb: VBIOS/hardware supports DDC1 "
-+                                "transfers\n");
-+       } else {
-+               printk(KERN_INFO "uvesafb: VBIOS/hardware doesn't support "
-+                                "DDC transfers\n");
-+               return -EINVAL;
-+       }
-+
-+       task->t.regs.eax = 0x4f15;
-+       task->t.regs.ebx = 1;
-+       task->t.regs.ecx = task->t.regs.edx = 0;
-+       task->t.flags = TF_BUF_RET | TF_BUF_ESDI;
-+       task->t.buf_len = EDID_LENGTH;
-+       task->buf = kzalloc(EDID_LENGTH, GFP_KERNEL);
-+
-+       err = uvesafb_exec(task);
-+
-+       if ((task->t.regs.eax & 0xffff) == 0x004f && !err) {
-+               fb_edid_to_monspecs(task->buf, &info->monspecs);
-+
-+               if (info->monspecs.vfmax && info->monspecs.hfmax) {
-+                       /*
-+                        * If the maximum pixel clock wasn't specified in
-+                        * the EDID block, set it to 300 MHz.
-+                        */
-+                       if (info->monspecs.dclkmax == 0)
-+                               info->monspecs.dclkmax = 300 * 1000000;
-+                       info->monspecs.gtf = 1;
-+               }
-+       } else {
-+               err = -EINVAL;
-+       }
-+
-+       kfree(task->buf);
-+       return err;
-+}
-+
-+static void __devinit uvesafb_vbe_getmonspecs(struct uvesafb_ktask *task,
-+               struct fb_info *info)
-+{
-+       struct uvesafb_par *par = info->par;
-+       int i;
-+
-+       memset(&info->monspecs, 0, sizeof(info->monspecs));
-+
-+       /*
-+        * If we don't get all necessary data from the EDID block,
-+        * mark it as incompatible with the GTF and set nocrtc so
-+        * that we always use the default BIOS refresh rate.
-+        */
-+       if (uvesafb_vbe_getedid(task, info)) {
-+               info->monspecs.gtf = 0;
-+               par->nocrtc = 1;
-+       }
-+
-+       /* Kernel command line overrides. */
-+       if (maxclk)
-+               info->monspecs.dclkmax = maxclk * 1000000;
-+       if (maxvf)
-+               info->monspecs.vfmax = maxvf;
-+       if (maxhf)
-+               info->monspecs.hfmax = maxhf * 1000;
-+
-+       /*
-+        * In case DDC transfers are not supported, the user can provide
-+        * monitor limits manually. Lower limits are set to "safe" values.
-+        */
-+       if (info->monspecs.gtf == 0 && maxclk && maxvf && maxhf) {
-+               info->monspecs.dclkmin = 0;
-+               info->monspecs.vfmin = 60;
-+               info->monspecs.hfmin = 29000;
-+               info->monspecs.gtf = 1;
-+               par->nocrtc = 0;
-+       }
-+
-+       if (info->monspecs.gtf)
-+               printk(KERN_INFO
-+                       "uvesafb: monitor limits: vf = %d Hz, hf = %d kHz, "
-+                       "clk = %d MHz\n", info->monspecs.vfmax,
-+                       (int)(info->monspecs.hfmax / 1000),
-+                       (int)(info->monspecs.dclkmax / 1000000));
-+       else
-+               printk(KERN_INFO "uvesafb: no monitor limits have been set, "
-+                                "default refresh rate will be used\n");
-+
-+       /* Add VBE modes to the modelist. */
-+       for (i = 0; i < par->vbe_modes_cnt; i++) {
-+               struct fb_var_screeninfo var;
-+               struct vbe_mode_ib *mode;
-+               struct fb_videomode vmode;
-+
-+               mode = &par->vbe_modes[i];
-+               memset(&var, 0, sizeof(var));
-+
-+               var.xres = mode->x_res;
-+               var.yres = mode->y_res;
-+
-+               fb_get_mode(FB_VSYNCTIMINGS | FB_IGNOREMON, 60, &var, info);
-+               fb_var_to_videomode(&vmode, &var);
-+               fb_add_videomode(&vmode, &info->modelist);
-+       }
-+
-+       /* Add valid VESA modes to our modelist. */
-+       for (i = 0; i < VESA_MODEDB_SIZE; i++) {
-+               if (uvesafb_is_valid_mode((struct fb_videomode *)
-+                                               &vesa_modes[i], info))
-+                       fb_add_videomode(&vesa_modes[i], &info->modelist);
-+       }
-+
-+       for (i = 0; i < info->monspecs.modedb_len; i++) {
-+               if (uvesafb_is_valid_mode(&info->monspecs.modedb[i], info))
-+                       fb_add_videomode(&info->monspecs.modedb[i],
-+                                       &info->modelist);
-+       }
-+
-+       return;
-+}
-+
-+static void __devinit uvesafb_vbe_getstatesize(struct uvesafb_ktask *task,
-+               struct uvesafb_par *par)
-+{
-+       int err;
-+
-+       uvesafb_reset(task);
-+
-+       /*
-+        * Get the VBE state buffer size. We want all available
-+        * hardware state data (CL = 0x0f).
-+        */
-+       task->t.regs.eax = 0x4f04;
-+       task->t.regs.ecx = 0x000f;
-+       task->t.regs.edx = 0x0000;
-+       task->t.flags = 0;
-+
-+       err = uvesafb_exec(task);
-+
-+       if (err || (task->t.regs.eax & 0xffff) != 0x004f) {
-+               printk(KERN_WARNING "uvesafb: VBE state buffer size "
-+                       "cannot be determined (eax=0x%x, err=%d)\n",
-+                       task->t.regs.eax, err);
-+               par->vbe_state_size = 0;
-+               return;
-+       }
-+
-+       par->vbe_state_size = 64 * (task->t.regs.ebx & 0xffff);
-+}
-+
-+static int __devinit uvesafb_vbe_init(struct fb_info *info)
-+{
-+       struct uvesafb_ktask *task = NULL;
-+       struct uvesafb_par *par = info->par;
-+       int err;
-+
-+       task = uvesafb_prep();
-+       if (!task)
-+               return -ENOMEM;
-+
-+       err = uvesafb_vbe_getinfo(task, par);
-+       if (err)
-+               goto out;
-+
-+       err = uvesafb_vbe_getmodes(task, par);
-+       if (err)
-+               goto out;
-+
-+       par->nocrtc = nocrtc;
-+#ifdef CONFIG_X86_32
-+       par->pmi_setpal = pmi_setpal;
-+       par->ypan = ypan;
-+
-+       if (par->pmi_setpal || par->ypan)
-+               uvesafb_vbe_getpmi(task, par);
-+#else
-+       /* The protected mode interface is not available on non-x86. */
-+       par->pmi_setpal = par->ypan = 0;
-+#endif
-+
-+       INIT_LIST_HEAD(&info->modelist);
-+       uvesafb_vbe_getmonspecs(task, info);
-+       uvesafb_vbe_getstatesize(task, par);
-+
-+out:   uvesafb_free(task);
-+       return err;
-+}
-+
-+static int __devinit uvesafb_vbe_init_mode(struct fb_info *info)
-+{
-+       struct list_head *pos;
-+       struct fb_modelist *modelist;
-+       struct fb_videomode *mode;
-+       struct uvesafb_par *par = info->par;
-+       int i, modeid;
-+
-+       /* Has the user requested a specific VESA mode? */
-+       if (vbemode) {
-+               for (i = 0; i < par->vbe_modes_cnt; i++) {
-+                       if (par->vbe_modes[i].mode_id == vbemode) {
-+                               fb_get_mode(FB_VSYNCTIMINGS | FB_IGNOREMON, 60,
-+                                                       &info->var, info);
-+                               /*
-+                                * With pixclock set to 0, the default BIOS
-+                                * timings will be used in set_par().
-+                                */
-+                               info->var.pixclock = 0;
-+                               modeid = i;
-+                               goto gotmode;
-+                       }
-+               }
-+               printk(KERN_INFO "uvesafb: requested VBE mode 0x%x is "
-+                                "unavailable\n", vbemode);
-+               vbemode = 0;
-+       }
-+
-+       /* Count the modes in the modelist */
-+       i = 0;
-+       list_for_each(pos, &info->modelist)
-+               i++;
-+
-+       /*
-+        * Convert the modelist into a modedb so that we can use it with
-+        * fb_find_mode().
-+        */
-+       mode = kzalloc(i * sizeof(*mode), GFP_KERNEL);
-+       if (mode) {
-+               i = 0;
-+               list_for_each(pos, &info->modelist) {
-+                       modelist = list_entry(pos, struct fb_modelist, list);
-+                       mode[i] = modelist->mode;
-+                       i++;
-+               }
-+
-+               if (!mode_option)
-+                       mode_option = UVESAFB_DEFAULT_MODE;
-+
-+               i = fb_find_mode(&info->var, info, mode_option, mode, i,
-+                       NULL, 8);
-+
-+               kfree(mode);
-+       }
-+
-+       /* fb_find_mode() failed */
-+       if (i == 0 || i >= 3) {
-+               info->var.xres = 640;
-+               info->var.yres = 480;
-+               mode = (struct fb_videomode *)
-+                               fb_find_best_mode(&info->var, &info->modelist);
-+
-+               if (mode) {
-+                       fb_videomode_to_var(&info->var, mode);
-+               } else {
-+                       modeid = par->vbe_modes[0].mode_id;
-+                       fb_get_mode(FB_VSYNCTIMINGS | FB_IGNOREMON, 60,
-+                                   &info->var, info);
-+                       goto gotmode;
-+               }
-+       }
-+
-+       /* Look for a matching VBE mode. */
-+       modeid = uvesafb_vbe_find_mode(par, info->var.xres, info->var.yres,
-+                       info->var.bits_per_pixel, UVESAFB_EXACT_RES);
-+
-+       if (modeid == -1)
-+               return -EINVAL;
-+
-+gotmode:
-+       uvesafb_setup_var(&info->var, info, &par->vbe_modes[modeid]);
-+
-+       /*
-+        * If we are not VBE3.0+ compliant, we're done -- the BIOS will
-+        * ignore our timings anyway.
-+        */
-+       if (par->vbe_ib.vbe_version < 0x0300 || par->nocrtc)
-+               fb_get_mode(FB_VSYNCTIMINGS | FB_IGNOREMON, 60,
-+                                       &info->var, info);
-+
-+       return modeid;
-+}
-+
-+static int uvesafb_setpalette(struct uvesafb_pal_entry *entries, int count,
-+               int start, struct fb_info *info)
-+{
-+       struct uvesafb_ktask *task;
-+       struct uvesafb_par *par = info->par;
-+       int i = par->mode_idx;
-+       int err = 0;
-+
-+       /*
-+        * We support palette modifications for 8 bpp modes only, so
-+        * there can never be more than 256 entries.
-+        */
-+       if (start + count > 256)
-+               return -EINVAL;
-+
-+       /* Use VGA registers if mode is VGA-compatible. */
-+       if (i >= 0 && i < par->vbe_modes_cnt &&
-+           par->vbe_modes[i].mode_attr & VBE_MODE_VGACOMPAT) {
-+               for (i = 0; i < count; i++) {
-+                       outb_p(start + i,        dac_reg);
-+                       outb_p(entries[i].red,   dac_val);
-+                       outb_p(entries[i].green, dac_val);
-+                       outb_p(entries[i].blue,  dac_val);
-+               }
-+       }
-+#ifdef CONFIG_X86_32
-+       else if (par->pmi_setpal) {
-+               __asm__ __volatile__(
-+               "call *(%%esi)"
-+               : /* no return value */
-+               : "a" (0x4f09),         /* EAX */
-+                 "b" (0),              /* EBX */
-+                 "c" (count),          /* ECX */
-+                 "d" (start),          /* EDX */
-+                 "D" (entries),        /* EDI */
-+                 "S" (&par->pmi_pal)); /* ESI */
-+       }
-+#endif
-+       else {
-+               task = uvesafb_prep();
-+               if (!task)
-+                       return -ENOMEM;
-+
-+               task->t.regs.eax = 0x4f09;
-+               task->t.regs.ebx = 0x0;
-+               task->t.regs.ecx = count;
-+               task->t.regs.edx = start;
-+               task->t.flags = TF_BUF_ESDI;
-+               task->t.buf_len = sizeof(struct uvesafb_pal_entry) * count;
-+               task->buf = entries;
-+
-+               err = uvesafb_exec(task);
-+               if ((task->t.regs.eax & 0xffff) != 0x004f)
-+                       err = 1;
-+
-+               uvesafb_free(task);
-+       }
-+       return err;
-+}
-+
-+static int uvesafb_setcolreg(unsigned regno, unsigned red, unsigned green,
-+               unsigned blue, unsigned transp,
-+               struct fb_info *info)
-+{
-+       struct uvesafb_pal_entry entry;
-+       int shift = 16 - info->var.green.length;
-+       int err = 0;
-+
-+       if (regno >= info->cmap.len)
-+               return -EINVAL;
-+
-+       if (info->var.bits_per_pixel == 8) {
-+               entry.red   = red   >> shift;
-+               entry.green = green >> shift;
-+               entry.blue  = blue  >> shift;
-+               entry.pad   = 0;
-+
-+               err = uvesafb_setpalette(&entry, 1, regno, info);
-+       } else if (regno < 16) {
-+               switch (info->var.bits_per_pixel) {
-+               case 16:
-+                       if (info->var.red.offset == 10) {
-+                               /* 1:5:5:5 */
-+                               ((u32 *) (info->pseudo_palette))[regno] =
-+                                               ((red   & 0xf800) >>  1) |
-+                                               ((green & 0xf800) >>  6) |
-+                                               ((blue  & 0xf800) >> 11);
-+                       } else {
-+                               /* 0:5:6:5 */
-+                               ((u32 *) (info->pseudo_palette))[regno] =
-+                                               ((red   & 0xf800)      ) |
-+                                               ((green & 0xfc00) >>  5) |
-+                                               ((blue  & 0xf800) >> 11);
-+                       }
-+                       break;
-+
-+               case 24:
-+               case 32:
-+                       red   >>= 8;
-+                       green >>= 8;
-+                       blue  >>= 8;
-+                       ((u32 *)(info->pseudo_palette))[regno] =
-+                               (red   << info->var.red.offset)   |
-+                               (green << info->var.green.offset) |
-+                               (blue  << info->var.blue.offset);
-+                       break;
-+               }
-+       }
-+       return err;
-+}
-+
-+static int uvesafb_setcmap(struct fb_cmap *cmap, struct fb_info *info)
-+{
-+       struct uvesafb_pal_entry *entries;
-+       int shift = 16 - info->var.green.length;
-+       int i, err = 0;
-+
-+       if (info->var.bits_per_pixel == 8) {
-+               if (cmap->start + cmap->len > info->cmap.start +
-+                   info->cmap.len || cmap->start < info->cmap.start)
-+                       return -EINVAL;
-+
-+               entries = kmalloc(sizeof(*entries) * cmap->len, GFP_KERNEL);
-+               if (!entries)
-+                       return -ENOMEM;
-+
-+               for (i = 0; i < cmap->len; i++) {
-+                       entries[i].red   = cmap->red[i]   >> shift;
-+                       entries[i].green = cmap->green[i] >> shift;
-+                       entries[i].blue  = cmap->blue[i]  >> shift;
-+                       entries[i].pad   = 0;
-+               }
-+               err = uvesafb_setpalette(entries, cmap->len, cmap->start, info);
-+               kfree(entries);
-+       } else {
-+               /*
-+                * For modes with bpp > 8, we only set the pseudo palette in
-+                * the fb_info struct. We rely on uvesafb_setcolreg to do all
-+                * sanity checking.
-+                */
-+               for (i = 0; i < cmap->len; i++) {
-+                       err |= uvesafb_setcolreg(cmap->start + i, cmap->red[i],
-+                                               cmap->green[i], cmap->blue[i],
-+                                               0, info);
-+               }
-+       }
-+       return err;
-+}
-+
-+static int uvesafb_pan_display(struct fb_var_screeninfo *var,
-+               struct fb_info *info)
-+{
-+#ifdef CONFIG_X86_32
-+       int offset;
-+       struct uvesafb_par *par = info->par;
-+
-+       offset = (var->yoffset * info->fix.line_length + var->xoffset) / 4;
-+
-+       /*
-+        * It turns out it's not the best idea to do panning via vm86,
-+        * so we only allow it if we have a PMI.
-+        */
-+       if (par->pmi_start) {
-+               __asm__ __volatile__(
-+                       "call *(%%edi)"
-+                       : /* no return value */
-+                       : "a" (0x4f07),         /* EAX */
-+                         "b" (0),              /* EBX */
-+                         "c" (offset),         /* ECX */
-+                         "d" (offset >> 16),   /* EDX */
-+                         "D" (&par->pmi_start));    /* EDI */
-+       }
-+#endif
-+       return 0;
-+}
-+
-+static int uvesafb_blank(int blank, struct fb_info *info)
-+{
-+       struct uvesafb_par *par = info->par;
-+       struct uvesafb_ktask *task;
-+       int err = 1;
-+
-+       if (par->vbe_ib.capabilities & VBE_CAP_VGACOMPAT) {
-+               int loop = 10000;
-+               u8 seq = 0, crtc17 = 0;
-+
-+               if (blank == FB_BLANK_POWERDOWN) {
-+                       seq = 0x20;
-+                       crtc17 = 0x00;
-+                       err = 0;
-+               } else {
-+                       seq = 0x00;
-+                       crtc17 = 0x80;
-+                       err = (blank == FB_BLANK_UNBLANK) ? 0 : -EINVAL;
-+               }
-+
-+               vga_wseq(NULL, 0x00, 0x01);
-+               seq |= vga_rseq(NULL, 0x01) & ~0x20;
-+               vga_wseq(NULL, 0x00, seq);
-+
-+               crtc17 |= vga_rcrt(NULL, 0x17) & ~0x80;
-+               while (loop--);
-+               vga_wcrt(NULL, 0x17, crtc17);
-+               vga_wseq(NULL, 0x00, 0x03);
-+       } else {
-+               task = uvesafb_prep();
-+               if (!task)
-+                       return -ENOMEM;
-+
-+               task->t.regs.eax = 0x4f10;
-+               switch (blank) {
-+               case FB_BLANK_UNBLANK:
-+                       task->t.regs.ebx = 0x0001;
-+                       break;
-+               case FB_BLANK_NORMAL:
-+                       task->t.regs.ebx = 0x0101;      /* standby */
-+                       break;
-+               case FB_BLANK_POWERDOWN:
-+                       task->t.regs.ebx = 0x0401;      /* powerdown */
-+                       break;
-+               default:
-+                       goto out;
-+               }
-+
-+               err = uvesafb_exec(task);
-+               if (err || (task->t.regs.eax & 0xffff) != 0x004f)
-+                       err = 1;
-+out:           uvesafb_free(task);
-+       }
-+       return err;
-+}
-+
-+static int uvesafb_open(struct fb_info *info, int user)
-+{
-+       struct uvesafb_par *par = info->par;
-+       int cnt = atomic_read(&par->ref_count);
-+
-+       if (!cnt && par->vbe_state_size)
-+               par->vbe_state_orig = uvesafb_vbe_state_save(par);
-+
-+       atomic_inc(&par->ref_count);
-+       return 0;
-+}
-+
-+static int uvesafb_release(struct fb_info *info, int user)
-+{
-+       struct uvesafb_ktask *task = NULL;
-+       struct uvesafb_par *par = info->par;
-+       int cnt = atomic_read(&par->ref_count);
-+
-+       if (!cnt)
-+               return -EINVAL;
-+
-+       if (cnt != 1)
-+               goto out;
-+
-+       task = uvesafb_prep();
-+       if (!task)
-+               goto out;
-+
-+       /* First, try to set the standard 80x25 text mode. */
-+       task->t.regs.eax = 0x0003;
-+       uvesafb_exec(task);
-+
-+       /*
-+        * Now try to restore whatever hardware state we might have
-+        * saved when the fb device was first opened.
-+        */
-+       uvesafb_vbe_state_restore(par, par->vbe_state_orig);
-+out:
-+       atomic_dec(&par->ref_count);
-+       if (task)
-+               uvesafb_free(task);
-+       return 0;
-+}
-+
-+static int uvesafb_set_par(struct fb_info *info)
-+{
-+       struct uvesafb_par *par = info->par;
-+       struct uvesafb_ktask *task = NULL;
-+       struct vbe_crtc_ib *crtc = NULL;
-+       struct vbe_mode_ib *mode = NULL;
-+       int i, err = 0, depth = info->var.bits_per_pixel;
-+
-+       if (depth > 8 && depth != 32)
-+               depth = info->var.red.length + info->var.green.length +
-+                       info->var.blue.length;
-+
-+       i = uvesafb_vbe_find_mode(par, info->var.xres, info->var.yres, depth,
-+                                UVESAFB_EXACT_RES | UVESAFB_EXACT_DEPTH);
-+       if (i >= 0)
-+               mode = &par->vbe_modes[i];
-+       else
-+               return -EINVAL;
-+
-+       task = uvesafb_prep();
-+       if (!task)
-+               return -ENOMEM;
-+setmode:
-+       task->t.regs.eax = 0x4f02;
-+       task->t.regs.ebx = mode->mode_id | 0x4000;      /* use LFB */
-+
-+       if (par->vbe_ib.vbe_version >= 0x0300 && !par->nocrtc &&
-+           info->var.pixclock != 0) {
-+               task->t.regs.ebx |= 0x0800;             /* use CRTC data */
-+               task->t.flags = TF_BUF_ESDI;
-+               crtc = kzalloc(sizeof(struct vbe_crtc_ib), GFP_KERNEL);
-+               if (!crtc) {
-+                       err = -ENOMEM;
-+                       goto out;
-+               }
-+               crtc->horiz_start = info->var.xres + info->var.right_margin;
-+               crtc->horiz_end   = crtc->horiz_start + info->var.hsync_len;
-+               crtc->horiz_total = crtc->horiz_end + info->var.left_margin;
-+
-+               crtc->vert_start  = info->var.yres + info->var.lower_margin;
-+               crtc->vert_end    = crtc->vert_start + info->var.vsync_len;
-+               crtc->vert_total  = crtc->vert_end + info->var.upper_margin;
-+
-+               crtc->pixel_clock = PICOS2KHZ(info->var.pixclock) * 1000;
-+               crtc->refresh_rate = (u16)(100 * (crtc->pixel_clock /
-+                               (crtc->vert_total * crtc->horiz_total)));
-+
-+               if (info->var.vmode & FB_VMODE_DOUBLE)
-+                       crtc->flags |= 0x1;
-+               if (info->var.vmode & FB_VMODE_INTERLACED)
-+                       crtc->flags |= 0x2;
-+               if (!(info->var.sync & FB_SYNC_HOR_HIGH_ACT))
-+                       crtc->flags |= 0x4;
-+               if (!(info->var.sync & FB_SYNC_VERT_HIGH_ACT))
-+                       crtc->flags |= 0x8;
-+               memcpy(&par->crtc, crtc, sizeof(*crtc));
-+       } else {
-+               memset(&par->crtc, 0, sizeof(*crtc));
-+       }
-+
-+       task->t.buf_len = sizeof(struct vbe_crtc_ib);
-+       task->buf = &par->crtc;
-+
-+       err = uvesafb_exec(task);
-+       if (err || (task->t.regs.eax & 0xffff) != 0x004f) {
-+               /*
-+                * The mode switch might have failed because we tried to
-+                * use our own timings.  Try again with the default timings.
-+                */
-+               if (crtc != NULL) {
-+                       printk(KERN_WARNING "uvesafb: mode switch failed "
-+                               "(eax=0x%x, err=%d). Trying again with "
-+                               "default timings.\n", task->t.regs.eax, err);
-+                       uvesafb_reset(task);
-+                       kfree(crtc);
-+                       crtc = NULL;
-+                       info->var.pixclock = 0;
-+                       goto setmode;
-+               } else {
-+                       printk(KERN_ERR "uvesafb: mode switch failed (eax="
-+                               "0x%x, err=%d)\n", task->t.regs.eax, err);
-+                       err = -EINVAL;
-+                       goto out;
-+               }
-+       }
-+       par->mode_idx = i;
-+
-+       /* For 8bpp modes, always try to set the DAC to 8 bits. */
-+       if (par->vbe_ib.capabilities & VBE_CAP_CAN_SWITCH_DAC &&
-+           mode->bits_per_pixel <= 8) {
-+               uvesafb_reset(task);
-+               task->t.regs.eax = 0x4f08;
-+               task->t.regs.ebx = 0x0800;
-+
-+               err = uvesafb_exec(task);
-+               if (err || (task->t.regs.eax & 0xffff) != 0x004f ||
-+                   ((task->t.regs.ebx & 0xff00) >> 8) != 8) {
-+                       /*
-+                        * We've failed to set the DAC palette format -
-+                        * time to correct var.
-+                        */
-+                       info->var.red.length    = 6;
-+                       info->var.green.length  = 6;
-+                       info->var.blue.length   = 6;
-+               }
-+       }
-+
-+       info->fix.visual = (info->var.bits_per_pixel == 8) ?
-+                               FB_VISUAL_PSEUDOCOLOR : FB_VISUAL_TRUECOLOR;
-+       info->fix.line_length = mode->bytes_per_scan_line;
-+
-+out:   if (crtc != NULL)
-+               kfree(crtc);
-+       uvesafb_free(task);
-+
-+       return err;
-+}
-+
-+static void uvesafb_check_limits(struct fb_var_screeninfo *var,
-+               struct fb_info *info)
-+{
-+       const struct fb_videomode *mode;
-+       struct uvesafb_par *par = info->par;
-+
-+       /*
-+        * If pixclock is set to 0, then we're using default BIOS timings
-+        * and thus don't have to perform any checks here.
-+        */
-+       if (!var->pixclock)
-+               return;
-+
-+       if (par->vbe_ib.vbe_version < 0x0300) {
-+               fb_get_mode(FB_VSYNCTIMINGS | FB_IGNOREMON, 60, var, info);
-+               return;
-+       }
-+
-+       if (!fb_validate_mode(var, info))
-+               return;
-+
-+       mode = fb_find_best_mode(var, &info->modelist);
-+       if (mode) {
-+               if (mode->xres == var->xres && mode->yres == var->yres &&
-+                   !(mode->vmode & (FB_VMODE_INTERLACED | FB_VMODE_DOUBLE))) {
-+                       fb_videomode_to_var(var, mode);
-+                       return;
-+               }
-+       }
-+
-+       if (info->monspecs.gtf && !fb_get_mode(FB_MAXTIMINGS, 0, var, info))
-+               return;
-+       /* Use default refresh rate */
-+       var->pixclock = 0;
-+}
-+
-+static int uvesafb_check_var(struct fb_var_screeninfo *var,
-+               struct fb_info *info)
-+{
-+       struct uvesafb_par *par = info->par;
-+       struct vbe_mode_ib *mode = NULL;
-+       int match = -1;
-+       int depth = var->red.length + var->green.length + var->blue.length;
-+
-+       /*
-+        * Various apps will use bits_per_pixel to set the color depth,
-+        * which is theoretically incorrect, but which we'll try to handle
-+        * here.
-+        */
-+       if (depth == 0 || abs(depth - var->bits_per_pixel) >= 8)
-+               depth = var->bits_per_pixel;
-+
-+       match = uvesafb_vbe_find_mode(par, var->xres, var->yres, depth,
-+                                               UVESAFB_EXACT_RES);
-+       if (match == -1)
-+               return -EINVAL;
-+
-+       mode = &par->vbe_modes[match];
-+       uvesafb_setup_var(var, info, mode);
-+
-+       /*
-+        * Check whether we have remapped enough memory for this mode.
-+        * We might be called at an early stage, when we haven't remapped
-+        * any memory yet, in which case we simply skip the check.
-+        */
-+       if (var->yres * mode->bytes_per_scan_line > info->fix.smem_len
-+                                               && info->fix.smem_len)
-+               return -EINVAL;
-+
-+       if ((var->vmode & FB_VMODE_DOUBLE) &&
-+                               !(par->vbe_modes[match].mode_attr & 0x100))
-+               var->vmode &= ~FB_VMODE_DOUBLE;
-+
-+       if ((var->vmode & FB_VMODE_INTERLACED) &&
-+                               !(par->vbe_modes[match].mode_attr & 0x200))
-+               var->vmode &= ~FB_VMODE_INTERLACED;
-+
-+       uvesafb_check_limits(var, info);
-+
-+       var->xres_virtual = var->xres;
-+       var->yres_virtual = (par->ypan) ?
-+                               info->fix.smem_len / mode->bytes_per_scan_line :
-+                               var->yres;
-+       return 0;
-+}
-+
-+static void uvesafb_save_state(struct fb_info *info)
-+{
-+       struct uvesafb_par *par = info->par;
-+
-+       if (par->vbe_state_saved)
-+               kfree(par->vbe_state_saved);
-+
-+       par->vbe_state_saved = uvesafb_vbe_state_save(par);
-+}
-+
-+static void uvesafb_restore_state(struct fb_info *info)
-+{
-+       struct uvesafb_par *par = info->par;
-+
-+       uvesafb_vbe_state_restore(par, par->vbe_state_saved);
-+}
-+
-+static struct fb_ops uvesafb_ops = {
-+       .owner          = THIS_MODULE,
-+       .fb_open        = uvesafb_open,
-+       .fb_release     = uvesafb_release,
-+       .fb_setcolreg   = uvesafb_setcolreg,
-+       .fb_setcmap     = uvesafb_setcmap,
-+       .fb_pan_display = uvesafb_pan_display,
-+       .fb_blank       = uvesafb_blank,
-+       .fb_fillrect    = cfb_fillrect,
-+       .fb_copyarea    = cfb_copyarea,
-+       .fb_imageblit   = cfb_imageblit,
-+       .fb_check_var   = uvesafb_check_var,
-+       .fb_set_par     = uvesafb_set_par,
-+       .fb_save_state  = uvesafb_save_state,
-+       .fb_restore_state = uvesafb_restore_state,
-+};
-+
-+static void __devinit uvesafb_init_info(struct fb_info *info,
-+               struct vbe_mode_ib *mode)
-+{
-+       unsigned int size_vmode;
-+       unsigned int size_remap;
-+       unsigned int size_total;
-+       struct uvesafb_par *par = info->par;
-+       int i, h;
-+
-+       info->pseudo_palette = ((u8 *)info->par + sizeof(struct uvesafb_par));
-+       info->fix = uvesafb_fix;
-+       info->fix.ypanstep = par->ypan ? 1 : 0;
-+       info->fix.ywrapstep = (par->ypan > 1) ? 1 : 0;
-+
-+       /*
-+        * If we were unable to get the state buffer size, disable
-+        * functions for saving and restoring the hardware state.
-+        */
-+       if (par->vbe_state_size == 0) {
-+               info->fbops->fb_save_state = NULL;
-+               info->fbops->fb_restore_state = NULL;
-+       }
-+
-+       /* Disable blanking if the user requested so. */
-+       if (!blank)
-+               info->fbops->fb_blank = NULL;
-+
-+       /*
-+        * Find out how much IO memory is required for the mode with
-+        * the highest resolution.
-+        */
-+       size_remap = 0;
-+       for (i = 0; i < par->vbe_modes_cnt; i++) {
-+               h = par->vbe_modes[i].bytes_per_scan_line *
-+                                       par->vbe_modes[i].y_res;
-+               if (h > size_remap)
-+                       size_remap = h;
-+       }
-+       size_remap *= 2;
-+
-+       /*
-+        *   size_vmode -- that is the amount of memory needed for the
-+        *                 used video mode, i.e. the minimum amount of
-+        *                 memory we need.
-+        */
-+       if (mode != NULL) {
-+               size_vmode = info->var.yres * mode->bytes_per_scan_line;
-+       } else {
-+               size_vmode = info->var.yres * info->var.xres *
-+                            ((info->var.bits_per_pixel + 7) >> 3);
-+       }
-+
-+       /*
-+        *   size_total -- all video memory we have. Used for mtrr
-+        *                 entries, resource allocation and bounds
-+        *                 checking.
-+        */
-+       size_total = par->vbe_ib.total_memory * 65536;
-+       if (vram_total)
-+               size_total = vram_total * 1024 * 1024;
-+       if (size_total < size_vmode)
-+               size_total = size_vmode;
-+
-+       /*
-+        *   size_remap -- the amount of video memory we are going to
-+        *                 use for vesafb.  With modern cards it is no
-+        *                 option to simply use size_total as th
-+        *                 wastes plenty of kernel address space.
-+        */
-+       if (vram_remap)
-+               size_remap = vram_remap * 1024 * 1024;
-+       if (size_remap < size_vmode)
-+               size_remap = size_vmode;
-+       if (size_remap > size_total)
-+               size_remap = size_total;
-+
-+       info->fix.smem_len = size_remap;
-+       info->fix.smem_start = mode->phys_base_ptr;
-+
-+       /*
-+        * We have to set yres_virtual here because when setup_var() was
-+        * called, smem_len wasn't defined yet.
-+        */
-+       info->var.yres_virtual = info->fix.smem_len /
-+                                mode->bytes_per_scan_line;
-+
-+       if (par->ypan && info->var.yres_virtual > info->var.yres) {
-+               printk(KERN_INFO "uvesafb: scrolling: %s "
-+                       "using protected mode interface, "
-+                       "yres_virtual=%d\n",
-+                       (par->ypan > 1) ? "ywrap" : "ypan",
-+                       info->var.yres_virtual);
-+       } else {
-+               printk(KERN_INFO "uvesafb: scrolling: redraw\n");
-+               info->var.yres_virtual = info->var.yres;
-+               par->ypan = 0;
-+       }
-+
-+       info->flags = FBINFO_FLAG_DEFAULT |
-+                       (par->ypan) ? FBINFO_HWACCEL_YPAN : 0;
-+
-+       if (!par->ypan)
-+               info->fbops->fb_pan_display = NULL;
-+}
-+
-+static void uvesafb_init_mtrr(struct fb_info *info)
-+{
-+#ifdef CONFIG_MTRR
-+       if (mtrr && !(info->fix.smem_start & (PAGE_SIZE - 1))) {
-+               int temp_size = info->fix.smem_len;
-+               unsigned int type = 0;
-+
-+               switch (mtrr) {
-+               case 1:
-+                       type = MTRR_TYPE_UNCACHABLE;
-+                       break;
-+               case 2:
-+                       type = MTRR_TYPE_WRBACK;
-+                       break;
-+               case 3:
-+                       type = MTRR_TYPE_WRCOMB;
-+                       break;
-+               case 4:
-+                       type = MTRR_TYPE_WRTHROUGH;
-+                       break;
-+               default:
-+                       type = 0;
-+                       break;
-+               }
-+
-+               if (type) {
-+                       int rc;
-+
-+                       /* Find the largest power-of-two */
-+                       while (temp_size & (temp_size - 1))
-+                               temp_size &= (temp_size - 1);
-+
-+                       /* Try and find a power of two to add */
-+                       do {
-+                               rc = mtrr_add(info->fix.smem_start,
-+                                             temp_size, type, 1);
-+                               temp_size >>= 1;
-+                       } while (temp_size >= PAGE_SIZE && rc == -EINVAL);
-+               }
-+       }
-+#endif /* CONFIG_MTRR */
-+}
-+
-+
-+static ssize_t uvesafb_show_vbe_ver(struct device *dev,
-+               struct device_attribute *attr, char *buf)
-+{
-+       struct fb_info *info = platform_get_drvdata(to_platform_device(dev));
-+       struct uvesafb_par *par = info->par;
-+
-+       return snprintf(buf, PAGE_SIZE, "%.4x\n", par->vbe_ib.vbe_version);
-+}
-+
-+static DEVICE_ATTR(vbe_version, S_IRUGO, uvesafb_show_vbe_ver, NULL);
-+
-+static ssize_t uvesafb_show_vbe_modes(struct device *dev,
-+               struct device_attribute *attr, char *buf)
-+{
-+       struct fb_info *info = platform_get_drvdata(to_platform_device(dev));
-+       struct uvesafb_par *par = info->par;
-+       int ret = 0, i;
-+
-+       for (i = 0; i < par->vbe_modes_cnt && ret < PAGE_SIZE; i++) {
-+               ret += snprintf(buf + ret, PAGE_SIZE - ret,
-+                       "%dx%d-%d, 0x%.4x\n",
-+                       par->vbe_modes[i].x_res, par->vbe_modes[i].y_res,
-+                       par->vbe_modes[i].depth, par->vbe_modes[i].mode_id);
-+       }
-+
-+       return ret;
-+}
-+
-+static DEVICE_ATTR(vbe_modes, S_IRUGO, uvesafb_show_vbe_modes, NULL);
-+
-+static ssize_t uvesafb_show_vendor(struct device *dev,
-+               struct device_attribute *attr, char *buf)
-+{
-+       struct fb_info *info = platform_get_drvdata(to_platform_device(dev));
-+       struct uvesafb_par *par = info->par;
-+
-+       if (par->vbe_ib.oem_vendor_name_ptr)
-+               return snprintf(buf, PAGE_SIZE, "%s\n", (char *)
-+                       (&par->vbe_ib) + par->vbe_ib.oem_vendor_name_ptr);
-+       else
-+               return 0;
-+}
-+
-+static DEVICE_ATTR(oem_vendor, S_IRUGO, uvesafb_show_vendor, NULL);
-+
-+static ssize_t uvesafb_show_product_name(struct device *dev,
-+               struct device_attribute *attr, char *buf)
-+{
-+       struct fb_info *info = platform_get_drvdata(to_platform_device(dev));
-+       struct uvesafb_par *par = info->par;
-+
-+       if (par->vbe_ib.oem_product_name_ptr)
-+               return snprintf(buf, PAGE_SIZE, "%s\n", (char *)
-+                       (&par->vbe_ib) + par->vbe_ib.oem_product_name_ptr);
-+       else
-+               return 0;
-+}
-+
-+static DEVICE_ATTR(oem_product_name, S_IRUGO, uvesafb_show_product_name, NULL);
-+
-+static ssize_t uvesafb_show_product_rev(struct device *dev,
-+               struct device_attribute *attr, char *buf)
-+{
-+       struct fb_info *info = platform_get_drvdata(to_platform_device(dev));
-+       struct uvesafb_par *par = info->par;
-+
-+       if (par->vbe_ib.oem_product_rev_ptr)
-+               return snprintf(buf, PAGE_SIZE, "%s\n", (char *)
-+                       (&par->vbe_ib) + par->vbe_ib.oem_product_rev_ptr);
-+       else
-+               return 0;
-+}
-+
-+static DEVICE_ATTR(oem_product_rev, S_IRUGO, uvesafb_show_product_rev, NULL);
-+
-+static ssize_t uvesafb_show_oem_string(struct device *dev,
-+               struct device_attribute *attr, char *buf)
-+{
-+       struct fb_info *info = platform_get_drvdata(to_platform_device(dev));
-+       struct uvesafb_par *par = info->par;
-+
-+       if (par->vbe_ib.oem_string_ptr)
-+               return snprintf(buf, PAGE_SIZE, "%s\n",
-+                       (char *)(&par->vbe_ib) + par->vbe_ib.oem_string_ptr);
-+       else
-+               return 0;
-+}
-+
-+static DEVICE_ATTR(oem_string, S_IRUGO, uvesafb_show_oem_string, NULL);
-+
-+static ssize_t uvesafb_show_nocrtc(struct device *dev,
-+               struct device_attribute *attr, char *buf)
-+{
-+       struct fb_info *info = platform_get_drvdata(to_platform_device(dev));
-+       struct uvesafb_par *par = info->par;
-+
-+       return snprintf(buf, PAGE_SIZE, "%d\n", par->nocrtc);
-+}
-+
-+static ssize_t uvesafb_store_nocrtc(struct device *dev,
-+               struct device_attribute *attr, const char *buf, size_t count)
-+{
-+       struct fb_info *info = platform_get_drvdata(to_platform_device(dev));
-+       struct uvesafb_par *par = info->par;
-+
-+       if (count > 0) {
-+               if (buf[0] == '0')
-+                       par->nocrtc = 0;
-+               else
-+                       par->nocrtc = 1;
-+       }
-+       return count;
-+}
-+
-+static DEVICE_ATTR(nocrtc, S_IRUGO | S_IWUSR, uvesafb_show_nocrtc,
-+                       uvesafb_store_nocrtc);
-+
-+static struct attribute *uvesafb_dev_attrs[] = {
-+       &dev_attr_vbe_version.attr,
-+       &dev_attr_vbe_modes.attr,
-+       &dev_attr_oem_vendor.attr,
-+       &dev_attr_oem_product_name.attr,
-+       &dev_attr_oem_product_rev.attr,
-+       &dev_attr_oem_string.attr,
-+       &dev_attr_nocrtc.attr,
-+       NULL,
-+};
-+
-+static struct attribute_group uvesafb_dev_attgrp = {
-+       .name = NULL,
-+       .attrs = uvesafb_dev_attrs,
-+};
-+
-+static int __devinit uvesafb_probe(struct platform_device *dev)
-+{
-+       struct fb_info *info;
-+       struct vbe_mode_ib *mode = NULL;
-+       struct uvesafb_par *par;
-+       int err = 0, i;
-+
-+       info = framebuffer_alloc(sizeof(*par) + sizeof(u32) * 256, &dev->dev);
-+       if (!info)
-+               return -ENOMEM;
-+
-+       par = info->par;
-+
-+       err = uvesafb_vbe_init(info);
-+       if (err) {
-+               printk(KERN_ERR "uvesafb: vbe_init() failed with %d\n", err);
-+               goto out;
-+       }
-+
-+       info->fbops = &uvesafb_ops;
-+
-+       i = uvesafb_vbe_init_mode(info);
-+       if (i < 0) {
-+               err = -EINVAL;
-+               goto out;
-+       } else {
-+               mode = &par->vbe_modes[i];
-+       }
-+
-+       if (fb_alloc_cmap(&info->cmap, 256, 0) < 0) {
-+               err = -ENXIO;
-+               goto out;
-+       }
-+
-+       uvesafb_init_info(info, mode);
-+
-+       if (!request_mem_region(info->fix.smem_start, info->fix.smem_len,
-+                               "uvesafb")) {
-+               printk(KERN_ERR "uvesafb: cannot reserve video memory at "
-+                               "0x%lx\n", info->fix.smem_start);
-+               err = -EIO;
-+               goto out_mode;
-+       }
-+
-+       info->screen_base = ioremap(info->fix.smem_start, info->fix.smem_len);
-+
-+       if (!info->screen_base) {
-+               printk(KERN_ERR
-+                       "uvesafb: abort, cannot ioremap 0x%x bytes of video "
-+                       "memory at 0x%lx\n",
-+                       info->fix.smem_len, info->fix.smem_start);
-+               err = -EIO;
-+               goto out_mem;
-+       }
-+
-+       if (!request_region(0x3c0, 32, "uvesafb")) {
-+               printk(KERN_ERR "uvesafb: request region 0x3c0-0x3e0 failed\n");
-+               err = -EIO;
-+               goto out_unmap;
-+       }
-+
-+       uvesafb_init_mtrr(info);
-+       platform_set_drvdata(dev, info);
-+
-+       if (register_framebuffer(info) < 0) {
-+               printk(KERN_ERR
-+                       "uvesafb: failed to register framebuffer device\n");
-+               err = -EINVAL;
-+               goto out_reg;
-+       }
-+
-+       printk(KERN_INFO "uvesafb: framebuffer at 0x%lx, mapped to 0x%p, "
-+                       "using %dk, total %dk\n", info->fix.smem_start,
-+                       info->screen_base, info->fix.smem_len/1024,
-+                       par->vbe_ib.total_memory * 64);
-+       printk(KERN_INFO "fb%d: %s frame buffer device\n", info->node,
-+                       info->fix.id);
-+
-+       err = sysfs_create_group(&dev->dev.kobj, &uvesafb_dev_attgrp);
-+       if (err != 0)
-+               printk(KERN_WARNING "fb%d: failed to register attributes\n",
-+                       info->node);
-+
-+       return 0;
-+
-+out_reg:
-+       release_region(0x3c0, 32);
-+out_unmap:
-+       iounmap(info->screen_base);
-+out_mem:
-+       release_mem_region(info->fix.smem_start, info->fix.smem_len);
-+out_mode:
-+       if (!list_empty(&info->modelist))
-+               fb_destroy_modelist(&info->modelist);
-+       fb_destroy_modedb(info->monspecs.modedb);
-+       fb_dealloc_cmap(&info->cmap);
-+out:
-+       if (par->vbe_modes)
-+               kfree(par->vbe_modes);
-+
-+       framebuffer_release(info);
-+       return err;
-+}
-+
-+static int uvesafb_remove(struct platform_device *dev)
-+{
-+       struct fb_info *info = platform_get_drvdata(dev);
-+
-+       if (info) {
-+               struct uvesafb_par *par = info->par;
-+
-+               sysfs_remove_group(&dev->dev.kobj, &uvesafb_dev_attgrp);
-+               unregister_framebuffer(info);
-+               release_region(0x3c0, 32);
-+               iounmap(info->screen_base);
-+               release_mem_region(info->fix.smem_start, info->fix.smem_len);
-+               fb_destroy_modedb(info->monspecs.modedb);
-+               fb_dealloc_cmap(&info->cmap);
-+
-+               if (par) {
-+                       if (par->vbe_modes)
-+                               kfree(par->vbe_modes);
-+                       if (par->vbe_state_orig)
-+                               kfree(par->vbe_state_orig);
-+                       if (par->vbe_state_saved)
-+                               kfree(par->vbe_state_saved);
-+               }
-+
-+               framebuffer_release(info);
-+       }
-+       return 0;
-+}
-+
-+static struct platform_driver uvesafb_driver = {
-+       .probe  = uvesafb_probe,
-+       .remove = uvesafb_remove,
-+       .driver = {
-+               .name = "uvesafb",
-+       },
-+};
-+
-+static struct platform_device *uvesafb_device;
-+
-+#ifndef MODULE
-+static int __devinit uvesafb_setup(char *options)
-+{
-+       char *this_opt;
-+
-+       if (!options || !*options)
-+               return 0;
-+
-+       while ((this_opt = strsep(&options, ",")) != NULL) {
-+               if (!*this_opt) continue;
-+
-+               if (!strcmp(this_opt, "redraw"))
-+                       ypan = 0;
-+               else if (!strcmp(this_opt, "ypan"))
-+                       ypan = 1;
-+               else if (!strcmp(this_opt, "ywrap"))
-+                       ypan = 2;
-+               else if (!strcmp(this_opt, "vgapal"))
-+                       pmi_setpal = 0;
-+               else if (!strcmp(this_opt, "pmipal"))
-+                       pmi_setpal = 1;
-+               else if (!strncmp(this_opt, "mtrr:", 5))
-+                       mtrr = simple_strtoul(this_opt+5, NULL, 0);
-+               else if (!strcmp(this_opt, "nomtrr"))
-+                       mtrr = 0;
-+               else if (!strcmp(this_opt, "nocrtc"))
-+                       nocrtc = 1;
-+               else if (!strcmp(this_opt, "noedid"))
-+                       noedid = 1;
-+               else if (!strcmp(this_opt, "noblank"))
-+                       blank = 0;
-+               else if (!strncmp(this_opt, "vtotal:", 7))
-+                       vram_total = simple_strtoul(this_opt + 7, NULL, 0);
-+               else if (!strncmp(this_opt, "vremap:", 7))
-+                       vram_remap = simple_strtoul(this_opt + 7, NULL, 0);
-+               else if (!strncmp(this_opt, "maxhf:", 6))
-+                       maxhf = simple_strtoul(this_opt + 6, NULL, 0);
-+               else if (!strncmp(this_opt, "maxvf:", 6))
-+                       maxvf = simple_strtoul(this_opt + 6, NULL, 0);
-+               else if (!strncmp(this_opt, "maxclk:", 7))
-+                       maxclk = simple_strtoul(this_opt + 7, NULL, 0);
-+               else if (!strncmp(this_opt, "vbemode:", 8))
-+                       vbemode = simple_strtoul(this_opt + 8, NULL, 0);
-+               else if (this_opt[0] >= '0' && this_opt[0] <= '9') {
-+                       mode_option = this_opt;
-+               } else {
-+                       printk(KERN_WARNING
-+                               "uvesafb: unrecognized option %s\n", this_opt);
-+               }
-+       }
-+
-+       return 0;
-+}
-+#endif /* !MODULE */
-+
-+static ssize_t show_v86d(struct device_driver *dev, char *buf)
-+{
-+       return snprintf(buf, PAGE_SIZE, "%s\n", v86d_path);
-+}
-+
-+static ssize_t store_v86d(struct device_driver *dev, const char *buf,
-+               size_t count)
-+{
-+       strncpy(v86d_path, buf, PATH_MAX);
-+       return count;
-+}
-+
-+static DRIVER_ATTR(v86d, S_IRUGO | S_IWUSR, show_v86d, store_v86d);
-+
-+static int __devinit uvesafb_init(void)
-+{
-+       int err;
-+
-+#ifndef MODULE
-+       char *option = NULL;
-+
-+       if (fb_get_options("uvesafb", &option))
-+               return -ENODEV;
-+       uvesafb_setup(option);
-+#endif
-+       err = cn_add_callback(&uvesafb_cn_id, "uvesafb", uvesafb_cn_callback);
-+       if (err)
-+               return err;
-+
-+       err = platform_driver_register(&uvesafb_driver);
-+
-+       if (!err) {
-+               uvesafb_device = platform_device_alloc("uvesafb", 0);
-+               if (uvesafb_device)
-+                       err = platform_device_add(uvesafb_device);
-+               else
-+                       err = -ENOMEM;
-+
-+               if (err) {
-+                       platform_device_put(uvesafb_device);
-+                       platform_driver_unregister(&uvesafb_driver);
-+                       cn_del_callback(&uvesafb_cn_id);
-+                       return err;
-+               }
-+
-+               err = driver_create_file(&uvesafb_driver.driver,
-+                               &driver_attr_v86d);
-+               if (err) {
-+                       printk(KERN_WARNING "uvesafb: failed to register "
-+                                       "attributes\n");
-+                       err = 0;
-+               }
-+       }
-+       return err;
-+}
-+
-+module_init(uvesafb_init);
-+
-+static void __devexit uvesafb_exit(void)
-+{
-+       struct uvesafb_ktask *task;
-+
-+       if (v86d_started) {
-+               task = uvesafb_prep();
-+               if (task) {
-+                       task->t.flags = TF_EXIT;
-+                       uvesafb_exec(task);
-+                       uvesafb_free(task);
-+               }
-+       }
-+
-+       cn_del_callback(&uvesafb_cn_id);
-+       driver_remove_file(&uvesafb_driver.driver, &driver_attr_v86d);
-+       platform_device_unregister(uvesafb_device);
-+       platform_driver_unregister(&uvesafb_driver);
-+}
-+
-+module_exit(uvesafb_exit);
-+
-+static inline int param_get_scroll(char *buffer, struct kernel_param *kp)
-+{
-+       return 0;
-+}
-+
-+static inline int param_set_scroll(const char *val, struct kernel_param *kp)
-+{
-+       ypan = 0;
-+
-+       if (!strcmp(val, "redraw"))
-+               ypan = 0;
-+       else if (!strcmp(val, "ypan"))
-+               ypan = 1;
-+       else if (!strcmp(val, "ywrap"))
-+               ypan = 2;
-+
-+       return 0;
-+}
-+
-+#define param_check_scroll(name, p) __param_check(name, p, void);
-+
-+module_param_named(scroll, ypan, scroll, 0);
-+MODULE_PARM_DESC(scroll,
-+       "Scrolling mode, set to 'redraw', ''ypan' or 'ywrap'");
-+module_param_named(vgapal, pmi_setpal, invbool, 0);
-+MODULE_PARM_DESC(vgapal, "Set palette using VGA registers");
-+module_param_named(pmipal, pmi_setpal, bool, 0);
-+MODULE_PARM_DESC(pmipal, "Set palette using PMI calls");
-+module_param(mtrr, uint, 0);
-+MODULE_PARM_DESC(mtrr,
-+       "Memory Type Range Registers setting. Use 0 to disable.");
-+module_param(blank, bool, 0);
-+MODULE_PARM_DESC(blank, "Enable hardware blanking");
-+module_param(nocrtc, bool, 0);
-+MODULE_PARM_DESC(nocrtc, "Ignore CRTC timings when setting modes");
-+module_param(noedid, bool, 0);
-+MODULE_PARM_DESC(noedid,
-+       "Ignore EDID-provided monitor limits when setting modes");
-+module_param(vram_remap, uint, 0);
-+MODULE_PARM_DESC(vram_remap, "Set amount of video memory to be used [MiB]");
-+module_param(vram_total, uint, 0);
-+MODULE_PARM_DESC(vram_total, "Set total amount of video memoery [MiB]");
-+module_param(maxclk, ushort, 0);
-+MODULE_PARM_DESC(maxclk, "Maximum pixelclock [MHz], overrides EDID data");
-+module_param(maxhf, ushort, 0);
-+MODULE_PARM_DESC(maxhf,
-+       "Maximum horizontal frequency [kHz], overrides EDID data");
-+module_param(maxvf, ushort, 0);
-+MODULE_PARM_DESC(maxvf,
-+       "Maximum vertical frequency [Hz], overrides EDID data");
-+module_param_named(mode, mode_option, charp, 0);
-+MODULE_PARM_DESC(mode,
-+       "Specify initial video mode as \"<xres>x<yres>[-<bpp>][@<refresh>]\"");
-+module_param(vbemode, ushort, 0);
-+MODULE_PARM_DESC(vbemode,
-+       "VBE mode number to set, overrides the 'mode' option");
-+module_param_string(v86d, v86d_path, PATH_MAX, 0660);
-+MODULE_PARM_DESC(v86d, "Path to the v86d userspace helper.");
-+
-+MODULE_LICENSE("GPL");
-+MODULE_AUTHOR("Michal Januszewski <spock@gentoo.org>");
-+MODULE_DESCRIPTION("Framebuffer driver for VBE2.0+ compliant graphics boards");
-+
-Index: linux-2.6.22/include/linux/connector.h
-===================================================================
---- linux-2.6.22.orig/include/linux/connector.h 2007-08-28 21:54:13.000000000 +0100
-+++ linux-2.6.22/include/linux/connector.h      2007-08-28 21:56:34.000000000 +0100
-@@ -36,14 +36,15 @@
- #define CN_VAL_CIFS                     0x1
- #define CN_W1_IDX                      0x3     /* w1 communication */
- #define CN_W1_VAL                      0x1
-+#define CN_IDX_V86D                    0x4
-+#define CN_VAL_V86D_UVESAFB            0x1
- 
--
--#define CN_NETLINK_USERS               4
-+#define CN_NETLINK_USERS               5
- 
- /*
-  * Maximum connector's message size.
-  */
--#define CONNECTOR_MAX_MSG_SIZE         1024
-+#define CONNECTOR_MAX_MSG_SIZE 16384
- 
- /*
-  * idx and val are unique identifiers which 
-Index: linux-2.6.22/include/video/Kbuild
-===================================================================
---- linux-2.6.22.orig/include/video/Kbuild      2007-08-28 21:54:13.000000000 +0100
-+++ linux-2.6.22/include/video/Kbuild   2007-08-28 21:56:34.000000000 +0100
-@@ -1 +1 @@
--unifdef-y += sisfb.h
-+unifdef-y += sisfb.h uvesafb.h
-Index: linux-2.6.22/include/video/uvesafb.h
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/include/video/uvesafb.h        2007-08-28 21:56:34.000000000 +0100
-@@ -0,0 +1,193 @@
-+#ifndef _UVESAFB_H
-+#define _UVESAFB_H
-+
-+struct v86_regs {
-+       __u32 ebx;
-+       __u32 ecx;
-+       __u32 edx;
-+       __u32 esi;
-+       __u32 edi;
-+       __u32 ebp;
-+       __u32 eax;
-+       __u32 eip;
-+       __u32 eflags;
-+       __u32 esp;
-+       __u16 cs;
-+       __u16 ss;
-+       __u16 es;
-+       __u16 ds;
-+       __u16 fs;
-+       __u16 gs;
-+};
-+
-+/* Task flags */
-+#define TF_VBEIB       0x01
-+#define TF_BUF_ESDI    0x02
-+#define TF_BUF_ESBX    0x04
-+#define TF_BUF_RET     0x08
-+#define TF_EXIT                0x10
-+
-+struct uvesafb_task {
-+       __u8 flags;
-+       int buf_len;
-+       struct v86_regs regs;
-+};
-+
-+/* Constants for the capabilities field
-+ * in vbe_ib */
-+#define VBE_CAP_CAN_SWITCH_DAC 0x01
-+#define VBE_CAP_VGACOMPAT      0x02
-+
-+/* The VBE Info Block */
-+struct vbe_ib {
-+       char  vbe_signature[4];
-+       __u16 vbe_version;
-+       __u32 oem_string_ptr;
-+       __u32 capabilities;
-+       __u32 mode_list_ptr;
-+       __u16 total_memory;
-+       __u16 oem_software_rev;
-+       __u32 oem_vendor_name_ptr;
-+       __u32 oem_product_name_ptr;
-+       __u32 oem_product_rev_ptr;
-+       __u8  reserved[222];
-+       char  oem_data[256];
-+       char  misc_data[512];
-+} __attribute__ ((packed));
-+
-+#ifdef __KERNEL__
-+
-+/* VBE CRTC Info Block */
-+struct vbe_crtc_ib {
-+       u16 horiz_total;
-+       u16 horiz_start;
-+       u16 horiz_end;
-+       u16 vert_total;
-+       u16 vert_start;
-+       u16 vert_end;
-+       u8  flags;
-+       u32 pixel_clock;
-+       u16 refresh_rate;
-+       u8  reserved[40];
-+} __attribute__ ((packed));
-+
-+#define VBE_MODE_VGACOMPAT     0x20
-+#define VBE_MODE_COLOR         0x08
-+#define VBE_MODE_SUPPORTEDHW   0x01
-+#define VBE_MODE_GRAPHICS      0x10
-+#define VBE_MODE_LFB           0x80
-+
-+#define VBE_MODE_MASK          (VBE_MODE_COLOR | VBE_MODE_SUPPORTEDHW | \
-+                               VBE_MODE_GRAPHICS | VBE_MODE_LFB)
-+
-+/* VBE Mode Info Block */
-+struct vbe_mode_ib {
-+       /* for all VBE revisions */
-+       u16 mode_attr;
-+       u8  winA_attr;
-+       u8  winB_attr;
-+       u16 win_granularity;
-+       u16 win_size;
-+       u16 winA_seg;
-+       u16 winB_seg;
-+       u32 win_func_ptr;
-+       u16 bytes_per_scan_line;
-+
-+       /* for VBE 1.2+ */
-+       u16 x_res;
-+       u16 y_res;
-+       u8  x_char_size;
-+       u8  y_char_size;
-+       u8  planes;
-+       u8  bits_per_pixel;
-+       u8  banks;
-+       u8  memory_model;
-+       u8  bank_size;
-+       u8  image_pages;
-+       u8  reserved1;
-+
-+       /* Direct color fields for direct/6 and YUV/7 memory models. */
-+       /* Offsets are bit positions of lsb in the mask. */
-+       u8  red_len;
-+       u8  red_off;
-+       u8  green_len;
-+       u8  green_off;
-+       u8  blue_len;
-+       u8  blue_off;
-+       u8  rsvd_len;
-+       u8  rsvd_off;
-+       u8  direct_color_info;  /* direct color mode attributes */
-+
-+       /* for VBE 2.0+ */
-+       u32 phys_base_ptr;
-+       u8  reserved2[6];
-+
-+       /* for VBE 3.0+ */
-+       u16 lin_bytes_per_scan_line;
-+       u8  bnk_image_pages;
-+       u8  lin_image_pages;
-+       u8  lin_red_len;
-+       u8  lin_red_off;
-+       u8  lin_green_len;
-+       u8  lin_green_off;
-+       u8  lin_blue_len;
-+       u8  lin_blue_off;
-+       u8  lin_rsvd_len;
-+       u8  lin_rsvd_off;
-+       u32 max_pixel_clock;
-+       u16 mode_id;
-+       u8  depth;
-+} __attribute__ ((packed));
-+
-+#define UVESAFB_DEFAULT_MODE "640x480-16"
-+
-+/* How long to wait for a reply from userspace [ms] */
-+#define UVESAFB_TIMEOUT 5000
-+
-+/* Max number of concurrent tasks */
-+#define UVESAFB_TASKS_MAX 16
-+
-+#define dac_reg        (0x3c8)
-+#define dac_val        (0x3c9)
-+
-+struct uvesafb_pal_entry {
-+       u_char blue, green, red, pad;
-+} __attribute__ ((packed));
-+
-+struct uvesafb_ktask {
-+       struct uvesafb_task t;
-+       void *buf;
-+       struct completion *done;
-+       u32 ack;
-+};
-+
-+static int uvesafb_exec(struct uvesafb_ktask *tsk);
-+
-+#define UVESAFB_EXACT_RES      1
-+#define UVESAFB_EXACT_DEPTH    2
-+
-+struct uvesafb_par {
-+       struct vbe_ib vbe_ib;           /* VBE Info Block */
-+       struct vbe_mode_ib *vbe_modes;  /* list of supported VBE modes */
-+       int vbe_modes_cnt;
-+
-+       u8 nocrtc;
-+       u8 ypan;                        /* 0 - nothing, 1 - ypan, 2 - ywrap */
-+       u8 pmi_setpal;                  /* PMI for palette changes */
-+       u16 *pmi_base;                  /* protected mode interface location */
-+       void *pmi_start;
-+       void *pmi_pal;
-+       u8 *vbe_state_orig;             /*
-+                                        * original hardware state, before the
-+                                        * driver was loaded
-+                                        */
-+       u8 *vbe_state_saved;            /* state saved by fb_save_state */
-+       int vbe_state_size;
-+       atomic_t ref_count;
-+
-+       int mode_idx;
-+       struct vbe_crtc_ib crtc;
-+};
-+
-+#endif /* __KERNEL__ */
-+#endif /* _UVESAFB_H */
diff --git a/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/vt_ioctl_race.patch b/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/vt_ioctl_race.patch
deleted file mode 100644
index 5a51d1c3f5..0000000000
--- a/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/vt_ioctl_race.patch
+++ /dev/null
@@ -1,46 +0,0 @@
----
- drivers/char/vt_ioctl.c |    8 +++++---
- 1 file changed, 5 insertions(+), 3 deletions(-)
-
-Index: linux-2.6.22/drivers/char/vt_ioctl.c
-===================================================================
---- linux-2.6.22.orig/drivers/char/vt_ioctl.c   2007-07-09 01:32:17.000000000 +0200
-+++ linux-2.6.22/drivers/char/vt_ioctl.c        2007-09-27 11:58:42.000000000 +0200
-@@ -770,6 +770,7 @@
-                /*
-                 * Switching-from response
-                 */
-+               acquire_console_sem();
-                if (vc->vt_newvt >= 0) {
-                        if (arg == 0)
-                                /*
-@@ -784,7 +785,6 @@
-                                 * complete the switch.
-                                 */
-                                int newvt;
--                               acquire_console_sem();
-                                newvt = vc->vt_newvt;
-                                vc->vt_newvt = -1;
-                                i = vc_allocate(newvt);
-@@ -798,7 +798,6 @@
-                                 * other console switches..
-                                 */
-                                complete_change_console(vc_cons[newvt].d);
--                               release_console_sem();
-                        }
-                }
- 
-@@ -810,9 +809,12 @@
-                        /*
-                         * If it's just an ACK, ignore it
-                         */
--                       if (arg != VT_ACKACQ)
-+                       if (arg != VT_ACKACQ) {
-+                               release_console_sem();
-                                return -EINVAL;
-+                       }
-                }
-+               release_console_sem();
- 
-                return 0;
- 
diff --git a/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/w100fb-unused-var.patch b/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/w100fb-unused-var.patch
deleted file mode 100644
index 8cbbb6bd01..0000000000
--- a/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/w100fb-unused-var.patch
+++ /dev/null
@@ -1,17 +0,0 @@
-From: Marcin Juszkiewicz <openembedded@haerwu.biz>
-
-drivers/video/w100fb.c: In function ‘w100fb_imageblit’:
-drivers/video/w100fb.c:507: warning: unused variable ‘par’
-
-Signed-off-by: Marcin Juszkiewicz <openembedded@haerwu.biz>
-
---- linux-2.6.23/drivers/video/w100fb.c 2007-10-11 16:52:30.000000000 +0200
-+++ linux-2.6.23/drivers/video/w100fb.c 2007-10-15 12:56:01.000000000 +0200
-@@ -504,7 +504,6 @@ static void w100_hostdata(u32 width, u32
- static void w100fb_imageblit(struct fb_info *info,
-                              const struct fb_image *image)
- {
--       struct w100fb_par *par = info->par;
-        union dp_gui_master_cntl_u gmc;
-        u32 fgcolor, bgcolor;
- 
diff --git a/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/wm97xx-lcdnoise-r0.patch b/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/wm97xx-lcdnoise-r0.patch
deleted file mode 100644
index 191de3af22..0000000000
--- a/meta/packages/linux/linux-rp-2.6.23+2.6.24-rc8/wm97xx-lcdnoise-r0.patch
+++ /dev/null
@@ -1,208 +0,0 @@
-Index: linux-tosa/drivers/input/touchscreen/wm9712.c
-===================================================================
---- linux-tosa.orig/drivers/input/touchscreen/wm9712.c  2006-08-29 16:52:36.008543280 +0100
-+++ linux-tosa/drivers/input/touchscreen/wm9712.c       2006-08-29 16:52:50.923275896 +0100
-@@ -1,7 +1,7 @@
- /*
-  * wm9712.c  --  Codec driver for Wolfson WM9712 AC97 Codecs.
-  *
-- * Copyright 2003, 2004, 2005 Wolfson Microelectronics PLC.
-+ * Copyright 2003, 2004, 2005, 2006 Wolfson Microelectronics PLC.
-  * Author: Liam Girdwood
-  *         liam.girdwood@wolfsonmicro.com or linux@wolfsonmicro.com
-  * Parts Copyright : Ian Molton <spyro@f2s.com>
-@@ -13,6 +13,12 @@
-  *  Free Software Foundation;  either version 2 of the  License, or (at your
-  *  option) any later version.
-  *
-+ *  Revision history
-+ *     4th Jul 2005  Initial version.
-+ *    29th Aug 2006  Mike Arthur <mike@mikearthur.co.uk>
-+ *                   Added fixes for Sharp SL-6000 (Tosa) LCD noise causing
-+ *                   touchscreen interference.
-+ *
-  */
- 
- #include <linux/module.h>
-@@ -28,6 +34,10 @@
- #define WM9705_VERSION         "0.60"
- #define DEFAULT_PRESSURE       0xb0c0
- 
-+#define CCNT(a)     asm volatile ("mrc p14, 0, %0, C1, C1, 0" : "=r"(a))
-+#define CCNT_ON()   asm("mcr p14, 0, %0, C0, C0, 0" : : "r"(1))
-+#define CCNT_OFF()  asm("mcr p14, 0, %0, C0, C0, 0" : : "r"(1))
-+
- /*
-  * Debug
-  */
-@@ -243,6 +253,36 @@
-        return wm->dig[2] & WM9712_PDEN;
- }
- 
-+
-+#ifdef CONFIG_MACH_TOSA
-+/* On the Sharp SL-6000 (Tosa), due to a noisy LCD, we need to perform a wait
-+ * before sampling the Y axis of the touchscreen */
-+static inline void wm9712_lcd_sync_on(struct wm97xx* wm, int adcsel) {
-+    unsigned long timer1 = 0, timer2 = 0, wait_time = 0;
-+    if (adcsel == WM97XX_ADCSEL_Y) {
-+        wait_time = wm97xx_calc_lcd_waittime(wm);
-+
-+        CCNT_ON();
-+
-+        if (wait_time) {
-+            /* wait for LCD rising edge */
-+            wm_machinfo->wait_hsync();
-+            /* get clock */
-+            CCNT(timer1);
-+            CCNT(timer2);
-+
-+            while ((timer2 - timer1) < wait_time) {
-+                CCNT(timer2);
-+            }
-+        }
-+    }
-+}
-+
-+static inline void wm9712_lcd_sync_off(void) {
-+    CCNT_OFF();
-+}
-+#endif
-+
- /*
-  * Read a sample from the WM9712 adc in polling mode.
-  */
-@@ -260,6 +300,9 @@
-        /* set up digitiser */
-        if (adcsel & 0x8000)
-                adcsel = ((adcsel & 0x7fff) + 3) << 12;
-+    #ifdef CONFIG_MACH_TOSA
-+    wm9712_lcd_sync_on(wm, adcsel);
-+    #endif
-        wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER1, adcsel | WM97XX_POLL | WM97XX_DELAY(delay));
-        
-        /* wait 3 AC97 time slots + delay for conversion */
-@@ -282,6 +325,10 @@
-        
-        *sample = wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER_RD);
-        
-+    #ifdef CONFIG_MACH_TOSA
-+    wm9712_lcd_sync_off();
-+    #endif
-+
-        /* check we have correct sample */
-        if ((*sample & WM97XX_ADCSEL_MASK) != adcsel) {
-                dbg ("adc wrong sample, read %x got %x", adcsel,
-@@ -303,11 +350,12 @@
- static int wm9712_poll_touch(struct wm97xx* wm, struct wm97xx_data *data)
- {
-        int rc;
--       
-        if ((rc = wm9712_poll_sample(wm, WM97XX_ADCSEL_X, &data->x)) != RC_VALID)
-                return rc;
-+
-        if ((rc = wm9712_poll_sample(wm, WM97XX_ADCSEL_Y, &data->y)) != RC_VALID)
-                return rc;
-+
-        if (pil && !five_wire) {
-                if ((rc = wm9712_poll_sample(wm, WM97XX_ADCSEL_PRES, &data->p)) != RC_VALID)
-                        return rc;
-Index: linux-tosa/drivers/input/touchscreen/wm97xx-core.c
-===================================================================
---- linux-tosa.orig/drivers/input/touchscreen/wm97xx-core.c     2006-08-29 16:52:36.008543280 +0100
-+++ linux-tosa/drivers/input/touchscreen/wm97xx-core.c  2006-08-29 16:52:50.924275744 +0100
-@@ -2,7 +2,7 @@
-  * wm97xx-core.c  --  Touch screen driver core for Wolfson WM9705, WM9712
-  *                           and WM9713 AC97 Codecs.
-  *
-- * Copyright 2003, 2004, 2005 Wolfson Microelectronics PLC.
-+ * Copyright 2003, 2004, 2005, 2006 Wolfson Microelectronics PLC.
-  * Author: Liam Girdwood
-  *         liam.girdwood@wolfsonmicro.com or linux@wolfsonmicro.com
-  * Parts Copyright : Ian Molton <spyro@f2s.com>
-@@ -67,6 +67,9 @@
-  *                   GPIOs) and 2.6 power management. 
-  *    29th Nov 2004  Added WM9713 support.
-  *     4th Jul 2005  Moved codec specific code out to seperate files.
-+ *    29th Aug 2006  Mike Arthur <mike@mikearthur.co.uk>
-+ *                   Added fixes for Sharp SL-6000 (Tosa) LCD noise causing
-+ *                   touchscreen interference.
-  */  
-     
- #include <linux/module.h>
-@@ -94,6 +97,7 @@
- static DECLARE_MUTEX(gpio_sem);
- static LIST_HEAD(wm97xx_misc_list);
- static struct wm97xx* wm_codec = NULL;
-+struct wm97xx_machinfo *wm_machinfo;
- 
- /*
-  * WM97xx - enable/disable AUX ADC sysfs 
-@@ -832,6 +836,23 @@
-                mdev->remove(wm_codec);
- }
- 
-+#ifdef CONFIG_MACH_TOSA
-+/* On the Sharp SL-6000 (Tosa), due to a noisy LCD, we need to perform a wait
-+ * before sampling the Y axis of the touchscreen */
-+unsigned long wm97xx_calc_lcd_waittime(struct wm97xx *wm) {
-+    unsigned long hsync_time = wm_machinfo->get_hsync_time();
-+    return hsync_time;
-+}
-+
-+void wm97xx_set_machinfo(struct wm97xx_machinfo *machinfo) {
-+    wm_machinfo = machinfo;
-+}
-+
-+void wm97xx_unset_machinfo() {
-+    wm_machinfo = NULL;
-+}
-+#endif
-+
- static struct device_driver wm97xx_driver = {
-        .name =         "ac97", 
-        .bus =          &ac97_bus_type, 
-@@ -861,6 +882,9 @@
- EXPORT_SYMBOL_GPL(wm97xx_reg_write);
- EXPORT_SYMBOL_GPL(wm97xx_register_misc_dev);
- EXPORT_SYMBOL_GPL(wm97xx_unregister_misc_dev);
-+EXPORT_SYMBOL_GPL(wm97xx_calc_lcd_waittime);
-+EXPORT_SYMBOL_GPL(wm97xx_set_machinfo);
-+EXPORT_SYMBOL_GPL(wm97xx_unset_machinfo);
- 
- module_init(wm97xx_init); 
- module_exit(wm97xx_exit);
-Index: linux-tosa/include/linux/wm97xx.h
-===================================================================
---- linux-tosa.orig/include/linux/wm97xx.h      2006-08-29 16:52:36.008543280 +0100
-+++ linux-tosa/include/linux/wm97xx.h   2006-08-29 16:52:50.924275744 +0100
-@@ -207,6 +207,7 @@
- 
- struct wm97xx;
- extern struct wm97xx_codec_drv wm97xx_codec;
-+extern struct wm97xx_machinfo *wm_machinfo;
- 
- /*
-  * Codec driver interface - allows mapping to WM9705/12/13 and newer codecs
-@@ -253,6 +254,11 @@
-        struct list_head list;
- };
- 
-+struct wm97xx_machinfo {
-+    unsigned long (*get_hsync_time)(void);
-+    void (*wait_hsync)(void);
-+};
-+
- int wm97xx_register_misc_dev(struct wm97xx_misc_dev* mdev);
- void wm97xx_unregister_misc_dev(struct wm97xx_misc_dev* mdev);
- 
-@@ -281,4 +287,9 @@
- int wm97xx_acc_startup(struct wm97xx* wm);
- void wm97xx_acc_shutdown(struct wm97xx* wm);
- 
-+
-+unsigned long wm97xx_calc_lcd_waittime(struct wm97xx *wm);
-+void wm97xx_set_machinfo(struct wm97xx_machinfo *machinfo);
-+void wm97xx_unset_machinfo(void);
-+
- #endif
diff --git a/meta/packages/linux/linux-rp-2.6.23/mmcsd_no_scr_check-r2.patch b/meta/packages/linux/linux-rp-2.6.23/mmcsd_no_scr_check-r2.patch
deleted file mode 100644
index ac2245f088..0000000000
--- a/meta/packages/linux/linux-rp-2.6.23/mmcsd_no_scr_check-r2.patch
+++ /dev/null
@@ -1,29 +0,0 @@
----
- drivers/mmc/core/sd.c |   11 ++++++-----
- 1 file changed, 6 insertions(+), 5 deletions(-)
-
-Index: linux-2.6.23/drivers/mmc/core/sd.c
-===================================================================
---- linux-2.6.23.orig/drivers/mmc/core/sd.c     2007-10-17 11:33:26.000000000 +0200
-+++ linux-2.6.23/drivers/mmc/core/sd.c  2007-10-17 11:33:49.000000000 +0200
-@@ -173,14 +173,15 @@
- 
-        scr_struct = UNSTUFF_BITS(resp, 60, 4);
-        if (scr_struct != 0) {
--               printk(KERN_ERR "%s: unrecognised SCR structure version %d\n",
-+               printk(KERN_WARNING "%s: unrecognised SCR structure version %d\n",
-                        mmc_hostname(card->host), scr_struct);
--               return -EINVAL;
-+               scr->sda_vsn = 0;
-+               scr->bus_widths = 0;
-+       } else {
-+               scr->sda_vsn = UNSTUFF_BITS(resp, 56, 4);
-+               scr->bus_widths = UNSTUFF_BITS(resp, 48, 4);
-        }
- 
--       scr->sda_vsn = UNSTUFF_BITS(resp, 56, 4);
--       scr->bus_widths = UNSTUFF_BITS(resp, 48, 4);
--
-        return 0;
- }
- 
diff --git a/meta/packages/linux/linux-rp-2.6.23/pda-power.patch b/meta/packages/linux/linux-rp-2.6.23/pda-power.patch
deleted file mode 100644
index face2f4ef2..0000000000
--- a/meta/packages/linux/linux-rp-2.6.23/pda-power.patch
+++ /dev/null
@@ -1,3373 +0,0 @@
----
- arch/arm/Kconfig                   |    2 
- drivers/Kconfig                    |    2 
- drivers/Makefile                   |    1 
- drivers/power/Kconfig              |   70 +++++
- drivers/power/Makefile             |   28 ++
- drivers/power/adc_battery.c        |  278 +++++++++++++++++++++
- drivers/power/apm_power.c          |  247 +++++++++++++++++++
- drivers/power/ds2760_battery.c     |  475 +++++++++++++++++++++++++++++++++++++
- drivers/power/micro_battery.c      |  257 ++++++++++++++++++++
- drivers/power/olpc_battery.c       |  302 +++++++++++++++++++++++
- drivers/power/pda_power.c          |  263 ++++++++++++++++++++
- drivers/power/pmu_battery.c        |  215 ++++++++++++++++
- drivers/power/power_supply.h       |   42 +++
- drivers/power/power_supply_core.c  |  168 +++++++++++++
- drivers/power/power_supply_leds.c  |  188 ++++++++++++++
- drivers/power/power_supply_sysfs.c |  289 ++++++++++++++++++++++
- drivers/power/simpad-battery.c     |  242 ++++++++++++++++++
- include/linux/power_supply.h       |  175 +++++++++++++
- 18 files changed, 3244 insertions(+)
-
-Index: linux-2.6.22/drivers/power/adc_battery.c
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/adc_battery.c    2007-08-23 12:26:28.000000000 +0200
-@@ -0,0 +1,278 @@
-+/*
-+ * Copyright (c) 2007 Paul Sokolovsky
-+ *
-+ * 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.
-+ *
-+ */
-+
-+//#define DEBUG
-+
-+#include <linux/module.h>
-+#include <linux/interrupt.h>
-+#include <linux/pm.h>
-+#include <linux/delay.h>
-+#include <linux/workqueue.h>
-+#include <linux/platform_device.h>
-+#include <linux/power_supply.h>
-+#include <linux/adc.h>
-+#include <linux/adc_battery.h>
-+
-+#include <asm/irq.h>
-+
-+#define PIN_NO_VOLT 0
-+#define PIN_NO_CURR 1
-+#define PIN_NO_TEMP 2
-+
-+struct battery_adc_priv {
-+       struct power_supply batt_cdev;
-+
-+       struct battery_adc_platform_data *pdata;
-+
-+       struct adc_request req;
-+       struct adc_sense pins[3];
-+       struct adc_sense last_good_pins[3];
-+
-+       struct workqueue_struct *wq;
-+       struct delayed_work work;
-+};
-+
-+/*
-+ *  Battery properties
-+ */
-+
-+static int adc_battery_get_property(struct power_supply *psy,
-+                                    enum power_supply_property psp,
-+                                    union power_supply_propval *val)
-+{
-+       struct battery_adc_priv* drvdata = (struct battery_adc_priv*)psy;
-+       int voltage;
-+
-+       switch (psp) {
-+       case POWER_SUPPLY_PROP_STATUS:
-+               val->intval = drvdata->pdata->charge_status;
-+               break;
-+       case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN:
-+               val->intval = drvdata->pdata->battery_info.voltage_max_design;
-+               break;
-+       case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN:
-+               val->intval = drvdata->pdata->battery_info.voltage_min_design;
-+               break;
-+       case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN:
-+               val->intval = drvdata->pdata->battery_info.charge_full_design;
-+               break;
-+       case POWER_SUPPLY_PROP_CHARGE_EMPTY_DESIGN:
-+               val->intval = drvdata->pdata->battery_info.charge_empty_design;
-+               break;
-+       case POWER_SUPPLY_PROP_VOLTAGE_NOW:
-+               val->intval = drvdata->last_good_pins[PIN_NO_VOLT].value * drvdata->pdata->voltage_mult;
-+               break;
-+       case POWER_SUPPLY_PROP_CURRENT_NOW:
-+               val->intval = drvdata->last_good_pins[PIN_NO_CURR].value * drvdata->pdata->current_mult;
-+               break;
-+       case POWER_SUPPLY_PROP_CHARGE_NOW:
-+               /* We do calculations in mX, not uX, because todo it in uX we should use "long long"s,
-+                * which is a mess (need to use do_div) when you need divide operation). */
-+               voltage = drvdata->last_good_pins[PIN_NO_VOLT].value * drvdata->pdata->voltage_mult;
-+               val->intval = ((voltage/1000 - drvdata->pdata->battery_info.voltage_min_design/1000) *
-+                    (drvdata->pdata->battery_info.charge_full_design/1000 -
-+                     drvdata->pdata->battery_info.charge_empty_design/1000)) /
-+                    (drvdata->pdata->battery_info.voltage_max_design/1000 -
-+                     drvdata->pdata->battery_info.voltage_min_design/1000);
-+               val->intval *= 1000; /* convert final result to uX */
-+               break;
-+       case POWER_SUPPLY_PROP_TEMP:
-+               val->intval = drvdata->last_good_pins[PIN_NO_TEMP].value * drvdata->pdata->temperature_mult / 1000;
-+               break;
-+       default:
-+               return -EINVAL;
-+       };
-+       return 0;
-+}
-+
-+/*
-+ *  Driver body
-+ */
-+
-+static void adc_battery_query(struct battery_adc_priv *drvdata)
-+{
-+       struct battery_adc_platform_data *pdata = drvdata->pdata;
-+       int powered, charging;
-+
-+       adc_request_sample(&drvdata->req);
-+
-+       powered = power_supply_am_i_supplied(&drvdata->batt_cdev);
-+       charging = pdata->is_charging ? pdata->is_charging() : -1;
-+
-+       if (powered && charging)
-+               pdata->charge_status = POWER_SUPPLY_STATUS_CHARGING;
-+       else if (powered && !charging && charging != -1)
-+               pdata->charge_status = POWER_SUPPLY_STATUS_FULL;
-+       else
-+               pdata->charge_status = POWER_SUPPLY_STATUS_DISCHARGING;
-+
-+       /* Throw away invalid samples, this may happen soon after resume for example. */
-+       if (drvdata->pins[PIN_NO_VOLT].value > 0) {
-+               memcpy(drvdata->last_good_pins, drvdata->pins, sizeof(drvdata->pins));
-+#ifdef DEBUG
-+               printk("%d %d %d\n", drvdata->pins[PIN_NO_VOLT].value,
-+                                    drvdata->pins[PIN_NO_CURR].value,
-+                                    drvdata->pins[PIN_NO_TEMP].value);
-+#endif
-+       }
-+}
-+
-+static void adc_battery_charge_power_changed(struct power_supply *bat)
-+{
-+       struct battery_adc_priv *drvdata = (struct battery_adc_priv*)bat;
-+       cancel_delayed_work(&drvdata->work);
-+       queue_delayed_work(drvdata->wq, &drvdata->work, 0);
-+}
-+
-+static void adc_battery_work_func(struct work_struct *work)
-+{
-+       struct delayed_work *delayed_work = container_of(work, struct delayed_work, work);
-+       struct battery_adc_priv *drvdata = container_of(delayed_work, struct battery_adc_priv, work);
-+
-+       adc_battery_query(drvdata);
-+       power_supply_changed(&drvdata->batt_cdev);
-+
-+       queue_delayed_work(drvdata->wq, &drvdata->work, (5000 * HZ) / 1000);
-+}
-+
-+static int adc_battery_probe(struct platform_device *pdev)
-+{
-+        int retval;
-+       struct battery_adc_platform_data *pdata = pdev->dev.platform_data;
-+       struct battery_adc_priv *drvdata;
-+       int i, j;
-+       enum power_supply_property props[] = {
-+               POWER_SUPPLY_PROP_STATUS,
-+               POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN,
-+               POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN,
-+               POWER_SUPPLY_PROP_VOLTAGE_NOW,
-+               POWER_SUPPLY_PROP_CURRENT_NOW,
-+               POWER_SUPPLY_PROP_CHARGE_NOW,
-+               POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN,
-+               POWER_SUPPLY_PROP_CHARGE_EMPTY_DESIGN,
-+               POWER_SUPPLY_PROP_TEMP,
-+       };
-+
-+       // Initialize ts data structure.
-+       drvdata = kzalloc(sizeof(*drvdata), GFP_KERNEL);
-+       if (!drvdata)
-+               return -ENOMEM;
-+
-+       drvdata->batt_cdev.name           = pdata->battery_info.name;
-+       drvdata->batt_cdev.use_for_apm    = pdata->battery_info.use_for_apm;
-+       drvdata->batt_cdev.num_properties = ARRAY_SIZE(props);
-+       drvdata->batt_cdev.get_property   = adc_battery_get_property;
-+       drvdata->batt_cdev.external_power_changed =
-+                                 adc_battery_charge_power_changed;
-+
-+       if (!pdata->voltage_pin) {
-+               drvdata->batt_cdev.num_properties--;
-+               props[3] = -1;
-+       }
-+       if (!pdata->current_pin) {
-+               drvdata->batt_cdev.num_properties--;
-+               props[4] = -1;
-+       }
-+       if (!pdata->temperature_pin) {
-+               drvdata->batt_cdev.num_properties--;
-+               props[8] = -1;
-+       }
-+
-+       drvdata->batt_cdev.properties = kmalloc(
-+                       sizeof(*drvdata->batt_cdev.properties) *
-+                       drvdata->batt_cdev.num_properties, GFP_KERNEL);
-+       if (!drvdata->batt_cdev.properties)
-+               return -ENOMEM;
-+
-+       j = 0;
-+       for (i = 0; i < ARRAY_SIZE(props); i++) {
-+               if (props[i] == -1)
-+                       continue;
-+               drvdata->batt_cdev.properties[j++] = props[i];
-+       }
-+
-+       retval = power_supply_register(&pdev->dev, &drvdata->batt_cdev);
-+       if (retval) {
-+               printk("adc-battery: Error registering battery classdev");
-+               return retval;
-+       }
-+
-+       drvdata->req.senses = drvdata->pins;
-+       drvdata->req.num_senses = ARRAY_SIZE(drvdata->pins);
-+       drvdata->pins[PIN_NO_VOLT].name = pdata->voltage_pin;
-+       drvdata->pins[PIN_NO_CURR].name = pdata->current_pin;
-+       drvdata->pins[PIN_NO_TEMP].name = pdata->temperature_pin;
-+
-+       adc_request_register(&drvdata->req);
-+
-+       /* Here we assume raw values in mV */
-+       if (!pdata->voltage_mult)
-+               pdata->voltage_mult = 1000;
-+       /* Here we assume raw values in mA */
-+       if (!pdata->current_mult)
-+               pdata->current_mult = 1000;
-+       /* Here we assume raw values in 1/10 C */
-+       if (!pdata->temperature_mult)
-+               pdata->temperature_mult = 1000;
-+
-+       drvdata->pdata = pdata;
-+       pdata->drvdata = drvdata; /* Seems ugly, we need better solution */
-+
-+       platform_set_drvdata(pdev, drvdata);
-+
-+        // Load initial values ASAP
-+       adc_battery_query(drvdata);
-+
-+       // Still schedule next sampling soon
-+       INIT_DELAYED_WORK(&drvdata->work, adc_battery_work_func);
-+       drvdata->wq = create_workqueue(pdev->dev.bus_id);
-+       if (!drvdata->wq)
-+               return -ESRCH;
-+
-+       queue_delayed_work(drvdata->wq, &drvdata->work, (5000 * HZ) / 1000);
-+
-+       return retval;
-+}
-+
-+static int adc_battery_remove(struct platform_device *pdev)
-+{
-+       struct battery_adc_priv *drvdata = platform_get_drvdata(pdev);
-+       cancel_delayed_work(&drvdata->work);
-+       destroy_workqueue(drvdata->wq);
-+       power_supply_unregister(&drvdata->batt_cdev);
-+       adc_request_unregister(&drvdata->req);
-+       kfree(drvdata->batt_cdev.properties);
-+       return 0;
-+}
-+
-+static struct platform_driver adc_battery_driver = {
-+       .driver         = {
-+               .name   = "adc-battery",
-+       },
-+       .probe          = adc_battery_probe,
-+       .remove         = adc_battery_remove,
-+};
-+
-+static int __init adc_battery_init(void)
-+{
-+       return platform_driver_register(&adc_battery_driver);
-+}
-+
-+static void __exit adc_battery_exit(void)
-+{
-+       platform_driver_unregister(&adc_battery_driver);
-+}
-+
-+module_init(adc_battery_init)
-+module_exit(adc_battery_exit)
-+
-+MODULE_AUTHOR("Paul Sokolovsky");
-+MODULE_DESCRIPTION("Battery driver for ADC device");
-+MODULE_LICENSE("GPL");
-Index: linux-2.6.22/drivers/power/apm_power.c
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/apm_power.c      2007-08-23 12:13:52.000000000 +0200
-@@ -0,0 +1,247 @@
-+/*
-+ * Copyright (c) 2007 Anton Vorontsov <cbou@mail.ru>
-+ * Copyright (c) 2007 Eugeny Boger <eugenyboger@dgap.mipt.ru>
-+ *
-+ * Author: Eugeny Boger <eugenyboger@dgap.mipt.ru>
-+ *
-+ * Use consistent with the GNU GPL is permitted,
-+ * provided that this copyright notice is
-+ * preserved in its entirety in all copies and derived works.
-+ */
-+
-+#include <linux/module.h>
-+#include <linux/power_supply.h>
-+#include <linux/apm-emulation.h>
-+
-+#define PSY_PROP(psy, prop, val) psy->get_property(psy, \
-+                         POWER_SUPPLY_PROP_##prop, val)
-+
-+#define _MPSY_PROP(prop, val) main_battery->get_property(main_battery, \
-+                                                         prop, val)
-+
-+#define MPSY_PROP(prop, val) _MPSY_PROP(POWER_SUPPLY_PROP_##prop, val)
-+
-+static struct power_supply *main_battery;
-+
-+static void find_main_battery(void)
-+{
-+       struct device *dev;
-+       struct power_supply *bat, *batm;
-+       union power_supply_propval full;
-+       int max_charge = 0;
-+
-+       main_battery = NULL;
-+       batm = NULL;
-+       list_for_each_entry(dev, &power_supply_class->devices, node) {
-+               bat = dev_get_drvdata(dev);
-+               /* If none of battery devices cantains 'use_for_apm' flag,
-+                  choice one with maximum design charge */
-+               if (!PSY_PROP(bat, CHARGE_FULL_DESIGN, &full)) {
-+                       if (full.intval > max_charge) {
-+                               batm = bat;
-+                               max_charge = full.intval;
-+                       }
-+               }
-+
-+               if (bat->use_for_apm)
-+                       main_battery = bat;
-+       }
-+       if (!main_battery)
-+               main_battery = batm;
-+
-+       return;
-+}
-+
-+static int calculate_time(int status)
-+{
-+       union power_supply_propval charge_full, charge_empty;
-+       union power_supply_propval charge, I;
-+
-+       if (MPSY_PROP(CHARGE_FULL, &charge_full)) {
-+               /* if battery can't report this property, use design value */
-+               if (MPSY_PROP(CHARGE_FULL_DESIGN, &charge_full))
-+                       return -1;
-+       }
-+
-+       if (MPSY_PROP(CHARGE_EMPTY, &charge_empty)) {
-+               /* if battery can't report this property, use design value */
-+               if (MPSY_PROP(CHARGE_EMPTY_DESIGN, &charge_empty))
-+                       charge_empty.intval = 0;
-+       }
-+
-+       if (MPSY_PROP(CHARGE_AVG, &charge)) {
-+               /* if battery can't report average value, use momentary */
-+               if (MPSY_PROP(CHARGE_NOW, &charge))
-+                       return -1;
-+       }
-+
-+       if (MPSY_PROP(CURRENT_AVG, &I)) {
-+               /* if battery can't report average value, use momentary */
-+               if (MPSY_PROP(CURRENT_NOW, &I))
-+                       return -1;
-+       }
-+
-+       if (I.intval == 0)
-+               return 0;
-+       else if (status == POWER_SUPPLY_STATUS_CHARGING)
-+               return ((charge.intval - charge_full.intval) * 60L) /
-+                      I.intval;
-+       else
-+               return -((charge.intval - charge_empty.intval) * 60L) /
-+                       I.intval;
-+}
-+
-+static int calculate_capacity(int using_charge)
-+{
-+       enum power_supply_property full_prop, empty_prop;
-+       enum power_supply_property full_design_prop, empty_design_prop;
-+       enum power_supply_property now_prop, avg_prop;
-+       union power_supply_propval empty, full, cur;
-+       int ret;
-+
-+       if (using_charge) {
-+               full_prop = POWER_SUPPLY_PROP_CHARGE_FULL;
-+               empty_prop = POWER_SUPPLY_PROP_CHARGE_EMPTY;
-+               full_design_prop = POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN;
-+               empty_design_prop = POWER_SUPPLY_PROP_CHARGE_EMPTY_DESIGN;
-+               now_prop = POWER_SUPPLY_PROP_CHARGE_NOW;
-+               avg_prop = POWER_SUPPLY_PROP_CHARGE_AVG;
-+       }
-+       else {
-+               full_prop = POWER_SUPPLY_PROP_ENERGY_FULL;
-+               empty_prop = POWER_SUPPLY_PROP_ENERGY_EMPTY;
-+               full_design_prop = POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN;
-+               empty_design_prop = POWER_SUPPLY_PROP_ENERGY_EMPTY_DESIGN;
-+               now_prop = POWER_SUPPLY_PROP_ENERGY_NOW;
-+               avg_prop = POWER_SUPPLY_PROP_ENERGY_AVG;
-+       }
-+
-+       if (_MPSY_PROP(full_prop, &full)) {
-+               /* if battery can't report this property, use design value */
-+               if (_MPSY_PROP(full_design_prop, &full))
-+                       return -1;
-+       }
-+
-+       if (_MPSY_PROP(avg_prop, &cur)) {
-+               /* if battery can't report average value, use momentary */
-+               if (_MPSY_PROP(now_prop, &cur))
-+                       return -1;
-+       }
-+
-+       if (_MPSY_PROP(empty_prop, &empty)) {
-+               /* if battery can't report this property, use design value */
-+               if (_MPSY_PROP(empty_design_prop, &empty))
-+                       empty.intval = 0;
-+       }
-+
-+       if (full.intval - empty.intval)
-+               ret =  ((cur.intval - empty.intval) * 100L) /
-+                      (full.intval - empty.intval);
-+       else
-+               return -1;
-+
-+       if (ret > 100)
-+               return 100;
-+       else if (ret < 0)
-+               return 0;
-+
-+       return ret;
-+}
-+
-+static void apm_battery_apm_get_power_status(struct apm_power_info *info)
-+{
-+       union power_supply_propval status;
-+       union power_supply_propval capacity, time_to_full, time_to_empty;
-+
-+       down(&power_supply_class->sem);
-+       find_main_battery();
-+       if (!main_battery) {
-+               up(&power_supply_class->sem);
-+               return;
-+       }
-+
-+       /* status */
-+
-+       if (MPSY_PROP(STATUS, &status))
-+               status.intval = POWER_SUPPLY_STATUS_UNKNOWN;
-+
-+       /* ac line status */
-+
-+       if ((status.intval == POWER_SUPPLY_STATUS_CHARGING) ||
-+           (status.intval == POWER_SUPPLY_STATUS_NOT_CHARGING) ||
-+           (status.intval == POWER_SUPPLY_STATUS_FULL))
-+               info->ac_line_status = APM_AC_ONLINE;
-+       else
-+               info->ac_line_status = APM_AC_OFFLINE;
-+
-+       /* battery life (i.e. capacity, in percents) */
-+
-+       if (MPSY_PROP(CAPACITY, &capacity) == 0)
-+               info->battery_life = capacity.intval;
-+       else {
-+               /* try calculate using energy */
-+               info->battery_life = calculate_capacity(0);
-+               /* if failed try calculate using charge instead */
-+               if (info->battery_life == -1)
-+                       info->battery_life = calculate_capacity(1);
-+       }
-+
-+       /* charging status */
-+
-+       if (status.intval == POWER_SUPPLY_STATUS_CHARGING)
-+               info->battery_status = APM_BATTERY_STATUS_CHARGING;
-+       else {
-+               if (info->battery_life > 50)
-+                       info->battery_status = APM_BATTERY_STATUS_HIGH;
-+               else if (info->battery_life > 5)
-+                       info->battery_status = APM_BATTERY_STATUS_LOW;
-+               else
-+                       info->battery_status = APM_BATTERY_STATUS_CRITICAL;
-+       }
-+       info->battery_flag = info->battery_status;
-+
-+       /* time */
-+
-+       info->units = APM_UNITS_MINS;
-+
-+       if (status.intval == POWER_SUPPLY_STATUS_CHARGING) {
-+               if (MPSY_PROP(TIME_TO_FULL_AVG, &time_to_full)) {
-+                       if (MPSY_PROP(TIME_TO_FULL_NOW, &time_to_full))
-+                               info->time = calculate_time(status.intval);
-+                       else
-+                               info->time = time_to_full.intval / 60;
-+               }
-+       }
-+       else {
-+               if (MPSY_PROP(TIME_TO_EMPTY_AVG, &time_to_empty)) {
-+                       if (MPSY_PROP(TIME_TO_EMPTY_NOW, &time_to_empty))
-+                               info->time = calculate_time(status.intval);
-+                       else
-+                               info->time = time_to_empty.intval / 60;
-+               }
-+       }
-+
-+       up(&power_supply_class->sem);
-+       return;
-+}
-+
-+static int __init apm_battery_init(void)
-+{
-+       printk(KERN_INFO "APM Battery Driver\n");
-+
-+       apm_get_power_status = apm_battery_apm_get_power_status;
-+       return 0;
-+}
-+
-+static void __exit apm_battery_exit(void)
-+{
-+       apm_get_power_status = NULL;
-+       return;
-+}
-+
-+module_init(apm_battery_init);
-+module_exit(apm_battery_exit);
-+
-+MODULE_AUTHOR("Eugeny Boger <eugenyboger@dgap.mipt.ru>");
-+MODULE_DESCRIPTION("APM emulation driver for battery monitoring class");
-+MODULE_LICENSE("GPL");
-Index: linux-2.6.22/drivers/power/ds2760_battery.c
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/ds2760_battery.c 2007-08-23 12:13:52.000000000 +0200
-@@ -0,0 +1,475 @@
-+/*
-+ * Driver for batteries with DS2760 chips inside.
-+ *
-+ * Copyright (c) 2007 Anton Vorontsov
-+ *               2004-2007 Matt Reimer
-+ *               2004 Szabolcs Gyurko
-+ *
-+ * Use consistent with the GNU GPL is permitted,
-+ * provided that this copyright notice is
-+ * preserved in its entirety in all copies and derived works.
-+ *
-+ * Author:  Anton Vorontsov <cbou@mail.ru>
-+ *          February 2007
-+ *
-+ *          Matt Reimer <mreimer@vpop.net>
-+ *          April 2004, 2005, 2007
-+ *
-+ *          Szabolcs Gyurko <szabolcs.gyurko@tlt.hu>
-+ *          September 2004
-+ */
-+
-+#include <linux/module.h>
-+#include <linux/param.h>
-+#include <linux/jiffies.h>
-+#include <linux/workqueue.h>
-+#include <linux/pm.h>
-+#include <linux/platform_device.h>
-+#include <linux/power_supply.h>
-+
-+#include "../w1/w1.h"
-+#include "../w1/slaves/w1_ds2760.h"
-+
-+struct ds2760_device_info {
-+       struct device *dev;
-+
-+       /* DS2760 data, valid after calling ds2760_battery_read_status() */
-+       unsigned long update_time;      /* jiffies when data read */
-+       char raw[DS2760_DATA_SIZE];     /* raw DS2760 data */
-+       int voltage_raw;                /* units of 4.88 mV */
-+       int voltage_uV;                 /* units of uV */
-+       int current_raw;                /* units of 0.625 mA */
-+       int current_uA;                 /* units of uA */
-+       int accum_current_raw;          /* units of 0.25 mAh */
-+       int accum_current_uAh;          /* units of uAh */
-+       int temp_raw;                   /* units of 0.125 C */
-+       int temp_C;                     /* units of 0.1 C */
-+       int rated_capacity;             /* units of uAh */
-+       int rem_capacity;               /* percentage */
-+       int full_active_uAh;            /* units of uAh */
-+       int empty_uAh;                  /* units of uAh */
-+       int life_sec;                   /* units of seconds */
-+       int charge_status;              /* POWER_SUPPLY_STATUS_* */
-+
-+       int full_counter;
-+       struct power_supply bat;
-+       struct device *w1_dev;
-+       struct workqueue_struct *monitor_wqueue;
-+       struct delayed_work monitor_work;
-+};
-+
-+static unsigned int cache_time = 1000;
-+module_param(cache_time, uint, 0644);
-+MODULE_PARM_DESC(cache_time, "cache time in milliseconds");
-+
-+/* Some batteries have their rated capacity stored a N * 10 mAh, while
-+ * others use an index into this table. */
-+static int rated_capacities[] = {
-+       0,
-+       920,        /* Samsung */
-+       920,        /* BYD */
-+       920,        /* Lishen */
-+       920,        /* NEC */
-+       1440,       /* Samsung */
-+       1440,       /* BYD */
-+       1440,       /* Lishen */
-+       1440,       /* NEC */
-+       2880,       /* Samsung */
-+       2880,       /* BYD */
-+       2880,       /* Lishen */
-+       2880        /* NEC */
-+};
-+
-+/* array is level at temps 0C, 10C, 20C, 30C, 40C
-+ * temp is in Celsius */
-+static int battery_interpolate(int array[], int temp)
-+{
-+       int index, dt;
-+
-+       if (temp <= 0)
-+               return array[0];
-+       if (temp >= 40)
-+               return array[4];
-+
-+       index = temp / 10;
-+       dt    = temp % 10;
-+
-+       return array[index] + (((array[index + 1] - array[index]) * dt) / 10);
-+}
-+
-+static int ds2760_battery_read_status(struct ds2760_device_info *di)
-+{
-+       int ret, i, start, count, scale[5];
-+
-+       if (di->update_time && time_before(jiffies, di->update_time +
-+                                          msecs_to_jiffies(cache_time)))
-+               return 0;
-+
-+       /* The first time we read the entire contents of SRAM/EEPROM,
-+        * but after that we just read the interesting bits that change. */
-+       if (di->update_time == 0) {
-+               start = 0;
-+               count = DS2760_DATA_SIZE;
-+       }
-+       else {
-+               start = DS2760_VOLTAGE_MSB;
-+               count = DS2760_TEMP_LSB - start + 1;
-+       }
-+
-+       ret = w1_ds2760_read(di->w1_dev, di->raw + start, start, count);
-+       if (ret != count) {
-+               dev_warn(di->dev, "call to w1_ds2760_read failed (0x%p)\n",
-+                        di->w1_dev);
-+               return 1;
-+       }
-+
-+       di->update_time = jiffies;
-+
-+       /* DS2760 reports voltage in units of 4.88mV, but the battery class
-+        * reports in units of uV, so convert by multiplying by 4880. */
-+       di->voltage_raw = (di->raw[DS2760_VOLTAGE_MSB] << 3) |
-+                         (di->raw[DS2760_VOLTAGE_LSB] >> 5);
-+       di->voltage_uV = di->voltage_raw * 4880;
-+
-+       /* DS2760 reports current in signed units of 0.625mA, but the battery
-+        * class reports in units of uA, so convert by multiplying by 625. */
-+       di->current_raw =
-+           (((signed char)di->raw[DS2760_CURRENT_MSB]) << 5) |
-+                         (di->raw[DS2760_CURRENT_LSB] >> 3);
-+       di->current_uA = di->current_raw * 625;
-+
-+       /* DS2760 reports accumulated current in signed units of 0.25mAh. */
-+       di->accum_current_raw =
-+           (((signed char)di->raw[DS2760_CURRENT_ACCUM_MSB]) << 8) |
-+                          di->raw[DS2760_CURRENT_ACCUM_LSB];
-+       di->accum_current_uAh = di->accum_current_raw * 250;
-+
-+       /* DS2760 reports temperature in signed units of 0.125C, but the
-+        * battery class reports in units of 1/10 C, so we convert by
-+        * multiplying by .125 * 10 = 1.25. */
-+       di->temp_raw = (((signed char)di->raw[DS2760_TEMP_MSB]) << 3) |
-+                                    (di->raw[DS2760_TEMP_LSB] >> 5);
-+       di->temp_C = di->temp_raw + (di->temp_raw / 4);
-+
-+       /* At least some battery monitors (e.g. HP iPAQ) store the battery's
-+        * maximum rated capacity. */
-+       if (di->raw[DS2760_RATED_CAPACITY] < ARRAY_SIZE(rated_capacities))
-+               di->rated_capacity = rated_capacities[
-+                       (unsigned int)di->raw[DS2760_RATED_CAPACITY]];
-+       else
-+               di->rated_capacity = di->raw[DS2760_RATED_CAPACITY] * 10;
-+
-+       di->rated_capacity *= 1000; /* convert to uAh */
-+
-+       /* Calculate the full level at the present temperature. */
-+       di->full_active_uAh = di->raw[DS2760_ACTIVE_FULL] << 8 |
-+                             di->raw[DS2760_ACTIVE_FULL + 1];
-+
-+       scale[0] = di->raw[DS2760_ACTIVE_FULL] << 8 |
-+                  di->raw[DS2760_ACTIVE_FULL + 1];
-+       for (i = 1; i < 5; i++)
-+               scale[i] = scale[i - 1] + di->raw[DS2760_ACTIVE_FULL + 2 + i];
-+
-+       di->full_active_uAh = battery_interpolate(scale, di->temp_C / 10);
-+       di->full_active_uAh *= 1000; /* convert to uAh */
-+
-+       /* Calculate the empty level at the present temperature. */
-+       scale[4] = di->raw[DS2760_ACTIVE_EMPTY + 4];
-+       for (i = 3; i >= 0; i--)
-+               scale[i] = scale[i + 1] + di->raw[DS2760_ACTIVE_EMPTY + i];
-+
-+       di->empty_uAh = battery_interpolate(scale, di->temp_C / 10);
-+       di->empty_uAh *= 1000; /* convert to uAh */
-+
-+       /* From Maxim Application Note 131: remaining capacity =
-+        * ((ICA - Empty Value) / (Full Value - Empty Value)) x 100% */
-+       di->rem_capacity = ((di->accum_current_uAh - di->empty_uAh) * 100L) /
-+                           (di->full_active_uAh - di->empty_uAh);
-+
-+       if (di->rem_capacity < 0)
-+               di->rem_capacity = 0;
-+       if (di->rem_capacity > 100)
-+               di->rem_capacity = 100;
-+
-+       if (di->current_uA)
-+               di->life_sec = -((di->accum_current_uAh - di->empty_uAh) *
-+                                3600L) / di->current_uA;
-+       else
-+               di->life_sec = 0;
-+
-+       return 0;
-+}
-+
-+static void ds2760_battery_update_status(struct ds2760_device_info *di)
-+{
-+       int old_charge_status = di->charge_status;
-+
-+       ds2760_battery_read_status(di);
-+
-+       if (di->charge_status == POWER_SUPPLY_STATUS_UNKNOWN)
-+               di->full_counter = 0;
-+
-+       if (power_supply_am_i_supplied(&di->bat)) {
-+               if (di->current_uA > 10000) {
-+                       di->charge_status = POWER_SUPPLY_STATUS_CHARGING;
-+                       di->full_counter = 0;
-+               }
-+               else if (di->current_uA < -5000) {
-+                       if (di->charge_status != POWER_SUPPLY_STATUS_NOT_CHARGING)
-+                               dev_notice(di->dev, "not enough power to "
-+                                          "charge\n");
-+                       di->charge_status = POWER_SUPPLY_STATUS_NOT_CHARGING;
-+                       di->full_counter = 0;
-+               }
-+               else if (di->current_uA < 10000 &&
-+                           di->charge_status != POWER_SUPPLY_STATUS_FULL) {
-+
-+                       /* Don't consider the battery to be full unless
-+                        * we've seen the current < 10 mA at least two
-+                        * consecutive times. */
-+
-+                       di->full_counter++;
-+
-+                       if (di->full_counter < 2)
-+                               di->charge_status = POWER_SUPPLY_STATUS_CHARGING;
-+                       else {
-+                               unsigned char acr[2];
-+                               int acr_val;
-+
-+                               /* acr is in units of 0.25 mAh */
-+                               acr_val = di->full_active_uAh * 4L / 1000;
-+
-+                               acr[0] = acr_val >> 8;
-+                               acr[1] = acr_val & 0xff;
-+
-+                               if (w1_ds2760_write(di->w1_dev, acr,
-+                                   DS2760_CURRENT_ACCUM_MSB, 2) < 2)
-+                                       dev_warn(di->dev,
-+                                                "ACR reset failed\n");
-+
-+                               di->charge_status = POWER_SUPPLY_STATUS_FULL;
-+                       }
-+               }
-+       }
-+       else {
-+               di->charge_status = POWER_SUPPLY_STATUS_DISCHARGING;
-+               di->full_counter = 0;
-+       }
-+
-+       if (di->charge_status != old_charge_status)
-+               power_supply_changed(&di->bat);
-+
-+       return;
-+}
-+
-+static void ds2760_battery_work(struct work_struct *work)
-+{
-+       struct ds2760_device_info *di = container_of(work,
-+               struct ds2760_device_info, monitor_work.work);
-+       const int interval = HZ * 60;
-+
-+       dev_dbg(di->dev, "%s\n", __FUNCTION__);
-+
-+       ds2760_battery_update_status(di);
-+       queue_delayed_work(di->monitor_wqueue, &di->monitor_work, interval);
-+
-+       return;
-+}
-+
-+#define to_ds2760_device_info(x) container_of((x), struct ds2760_device_info, \
-+                                              bat);
-+
-+static void ds2760_battery_external_power_changed(struct power_supply *psy)
-+{
-+       struct ds2760_device_info *di = to_ds2760_device_info(psy);
-+
-+       dev_dbg(di->dev, "%s\n", __FUNCTION__);
-+
-+       cancel_delayed_work(&di->monitor_work);
-+       queue_delayed_work(di->monitor_wqueue, &di->monitor_work, HZ/10);
-+
-+       return;
-+}
-+
-+static int ds2760_battery_get_property(struct power_supply *psy,
-+                                       enum power_supply_property psp,
-+                                       union power_supply_propval *val)
-+{
-+       struct ds2760_device_info *di = to_ds2760_device_info(psy);
-+
-+       switch (psp) {
-+       case POWER_SUPPLY_PROP_STATUS:
-+               val->intval = di->charge_status;
-+               return 0;
-+       default:
-+               break;
-+       }
-+
-+       ds2760_battery_read_status(di);
-+
-+       switch (psp) {
-+       case POWER_SUPPLY_PROP_VOLTAGE_NOW:
-+               val->intval = di->voltage_uV;
-+               break;
-+       case POWER_SUPPLY_PROP_CURRENT_NOW:
-+               val->intval = di->current_uA;
-+               break;
-+       case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN:
-+               val->intval = di->rated_capacity;
-+               break;
-+       case POWER_SUPPLY_PROP_CHARGE_FULL:
-+               val->intval = di->full_active_uAh;
-+               break;
-+       case POWER_SUPPLY_PROP_CHARGE_EMPTY:
-+               val->intval = di->empty_uAh;
-+               break;
-+       case POWER_SUPPLY_PROP_CHARGE_NOW:
-+               val->intval = di->accum_current_uAh;
-+               break;
-+       case POWER_SUPPLY_PROP_TEMP:
-+               val->intval = di->temp_C;
-+               break;
-+       default:
-+               return -EINVAL;
-+       }
-+
-+       return 0;
-+}
-+
-+static enum power_supply_property ds2760_battery_props[] = {
-+       POWER_SUPPLY_PROP_STATUS,
-+       POWER_SUPPLY_PROP_VOLTAGE_NOW,
-+       POWER_SUPPLY_PROP_CURRENT_NOW,
-+       POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN,
-+       POWER_SUPPLY_PROP_CHARGE_FULL,
-+       POWER_SUPPLY_PROP_CHARGE_EMPTY,
-+       POWER_SUPPLY_PROP_CHARGE_NOW,
-+       POWER_SUPPLY_PROP_TEMP,
-+};
-+
-+static int ds2760_battery_probe(struct platform_device *pdev)
-+{
-+       int retval = 0;
-+       struct ds2760_device_info *di;
-+       struct ds2760_platform_data *pdata;
-+
-+       di = kzalloc(sizeof(*di), GFP_KERNEL);
-+       if (!di) {
-+               retval = -ENOMEM;
-+               goto di_alloc_failed;
-+       }
-+
-+       platform_set_drvdata(pdev, di);
-+
-+       pdata = pdev->dev.platform_data;
-+       di->dev                = &pdev->dev;
-+       di->w1_dev             = pdev->dev.parent;
-+       di->bat.name           = pdev->dev.bus_id;
-+       di->bat.type           = POWER_SUPPLY_TYPE_BATTERY;
-+       di->bat.properties     = ds2760_battery_props;
-+       di->bat.num_properties = ARRAY_SIZE(ds2760_battery_props);
-+       di->bat.get_property   = ds2760_battery_get_property;
-+       di->bat.external_power_changed =
-+                                 ds2760_battery_external_power_changed;
-+       di->bat.use_for_apm = 1;
-+
-+       di->charge_status = POWER_SUPPLY_STATUS_UNKNOWN;
-+
-+       retval = power_supply_register(&pdev->dev, &di->bat);
-+       if (retval) {
-+               dev_err(di->dev, "failed to register battery");
-+               goto batt_failed;
-+       }
-+
-+       INIT_DELAYED_WORK(&di->monitor_work, ds2760_battery_work);
-+       di->monitor_wqueue = create_singlethread_workqueue(pdev->dev.bus_id);
-+       if (!di->monitor_wqueue) {
-+               retval = -ESRCH;
-+               goto workqueue_failed;
-+       }
-+       queue_delayed_work(di->monitor_wqueue, &di->monitor_work, HZ * 1);
-+
-+       goto success;
-+
-+workqueue_failed:
-+       power_supply_unregister(&di->bat);
-+batt_failed:
-+       kfree(di);
-+di_alloc_failed:
-+success:
-+       return retval;
-+}
-+
-+static int ds2760_battery_remove(struct platform_device *pdev)
-+{
-+       struct ds2760_device_info *di = platform_get_drvdata(pdev);
-+
-+       cancel_rearming_delayed_workqueue(di->monitor_wqueue,
-+                                         &di->monitor_work);
-+       destroy_workqueue(di->monitor_wqueue);
-+       power_supply_unregister(&di->bat);
-+
-+       return 0;
-+}
-+
-+#ifdef CONFIG_PM
-+
-+static int ds2760_battery_suspend(struct platform_device *pdev,
-+                                  pm_message_t state)
-+{
-+       struct ds2760_device_info *di = platform_get_drvdata(pdev);
-+
-+       di->charge_status = POWER_SUPPLY_STATUS_UNKNOWN;
-+
-+       return 0;
-+}
-+
-+static int ds2760_battery_resume(struct platform_device *pdev)
-+{
-+       struct ds2760_device_info *di = platform_get_drvdata(pdev);
-+
-+       di->charge_status = POWER_SUPPLY_STATUS_UNKNOWN;
-+       power_supply_changed(&di->bat);
-+
-+       cancel_delayed_work(&di->monitor_work);
-+       queue_delayed_work(di->monitor_wqueue, &di->monitor_work, HZ);
-+
-+       return 0;
-+}
-+
-+#else
-+
-+#define ds2760_battery_suspend NULL
-+#define ds2760_battery_resume NULL
-+
-+#endif /* CONFIG_PM */
-+
-+static struct platform_driver ds2760_battery_driver = {
-+       .driver = {
-+               .name = "ds2760-battery",
-+       },
-+       .probe    = ds2760_battery_probe,
-+       .remove   = ds2760_battery_remove,
-+       .suspend  = ds2760_battery_suspend,
-+       .resume   = ds2760_battery_resume,
-+};
-+
-+static int __init ds2760_battery_init(void)
-+{
-+       return platform_driver_register(&ds2760_battery_driver);
-+}
-+
-+static void __exit ds2760_battery_exit(void)
-+{
-+       platform_driver_unregister(&ds2760_battery_driver);
-+       return;
-+}
-+
-+module_init(ds2760_battery_init);
-+module_exit(ds2760_battery_exit);
-+
-+MODULE_LICENSE("GPL");
-+MODULE_AUTHOR("Szabolcs Gyurko <szabolcs.gyurko@tlt.hu>, "
-+              "Matt Reimer <mreimer@vpop.net>, "
-+              "Anton Vorontsov <cbou@mail.ru>");
-+MODULE_DESCRIPTION("ds2760 battery driver");
-Index: linux-2.6.22/drivers/power/Kconfig
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/Kconfig  2007-08-23 12:13:52.000000000 +0200
-@@ -0,0 +1,70 @@
-+menuconfig POWER_SUPPLY
-+       tristate "Power supply class support"
-+       help
-+         Say Y here to enable power supply class support. This allows
-+         power supply (batteries, AC, USB) monitoring by userspace
-+         via sysfs and uevent (if available) and/or APM kernel interface
-+         (if selected below).
-+
-+if POWER_SUPPLY
-+
-+config POWER_SUPPLY_DEBUG
-+       bool "Power supply debug"
-+       help
-+         Say Y here to enable debugging messages for power supply class
-+         and drivers.
-+
-+config PDA_POWER
-+       tristate "Generic PDA/phone power driver"
-+       help
-+         Say Y here to enable generic power driver for PDAs and phones with
-+         one or two external power supplies (AC/USB) connected to main and
-+         backup batteries, and optional builtin charger.
-+
-+config APM_POWER
-+       tristate "APM emulation for class batteries"
-+       depends on APM_EMULATION
-+       help
-+         Say Y here to enable support APM status emulation using
-+         battery class devices.
-+
-+config BATTERY_DS2760
-+       tristate "DS2760 battery driver (HP iPAQ & others)"
-+       select W1
-+       select W1_SLAVE_DS2760
-+       help
-+         Say Y here to enable support for batteries with ds2760 chip.
-+
-+config BATTERY_PMU
-+       tristate "Apple PMU battery"
-+       depends on ADB_PMU
-+       help
-+         Say Y here to expose battery information on Apple machines
-+         through the generic battery class.
-+
-+config BATTERY_OLPC
-+       tristate "One Laptop Per Child battery"
-+       depends on X86_32
-+       help
-+         Say Y to enable support for the battery on the OLPC laptop.
-+
-+# drivers below are not in battery2-2.6 tree
-+
-+config ADC_BATTERY
-+       tristate "Generic ADC battery driver"
-+       depends on ADC && POWER_SUPPLY
-+       help
-+         Say Y here to enable support for battery monitoring using generic ADC device.
-+
-+config IPAQ_MICRO_BATTERY
-+       tristate "HP iPAQ Micro ASIC battery driver"
-+       depends on IPAQ_MICRO && POWER_SUPPLY
-+       help
-+         Choose this option if you want to monitor battery status on
-+         Compaq/HP iPAQ h3100 h3600
-+
-+config MCP_UCB1x00_SIMPAD_BATTERY
-+       tristate "SIMpad Battery Reading Support"
-+       depends on MCP_UCB1x00 && POWER_SUPPLY
-+
-+endif # POWER_SUPPLY
-Index: linux-2.6.22/drivers/power/Makefile
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/Makefile 2007-08-23 12:13:52.000000000 +0200
-@@ -0,0 +1,28 @@
-+power_supply-objs := power_supply_core.o
-+
-+ifeq ($(CONFIG_SYSFS),y)
-+power_supply-objs += power_supply_sysfs.o
-+endif
-+
-+ifeq ($(CONFIG_LEDS_TRIGGERS),y)
-+power_supply-objs += power_supply_leds.o
-+endif
-+
-+ifeq ($(CONFIG_POWER_SUPPLY_DEBUG),y)
-+EXTRA_CFLAGS += -DDEBUG
-+endif
-+
-+obj-$(CONFIG_POWER_SUPPLY)         += power_supply.o
-+
-+obj-$(CONFIG_PDA_POWER)            += pda_power.o
-+obj-$(CONFIG_APM_POWER)            += apm_power.o
-+
-+obj-$(CONFIG_BATTERY_DS2760)       += ds2760_battery.o
-+obj-$(CONFIG_BATTERY_PMU)          += pmu_battery.o
-+obj-$(CONFIG_BATTERY_OLPC)         += olpc_battery.o
-+
-+# drivers below are not in battery2-2.6 tree
-+
-+obj-$(CONFIG_ADC_BATTERY)          += adc_battery.o
-+obj-$(CONFIG_IPAQ_MICRO_BATTERY)   += micro_battery.o
-+obj-$(CONFIG_MCP_UCB1x00_SIMPAD_BATTERY) += simpad-battery.o
-Index: linux-2.6.22/drivers/power/micro_battery.c
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/micro_battery.c  2007-08-23 12:25:20.000000000 +0200
-@@ -0,0 +1,257 @@
-+/*
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ *
-+ * h3600 atmel micro companion support, battery subdevice
-+ * based on previous kernel 2.4 version
-+ * Author : Alessandro Gardich <gremlin@gremlin.it>
-+ *
-+ */
-+
-+
-+#include <linux/module.h>
-+#include <linux/version.h>
-+
-+#include <linux/init.h>
-+#include <linux/fs.h>
-+#include <linux/interrupt.h>
-+#include <linux/sched.h>
-+#include <linux/pm.h>
-+#include <linux/sysctl.h>
-+#include <linux/proc_fs.h>
-+#include <linux/delay.h>
-+#include <linux/device.h>
-+#include <linux/power_supply.h>
-+#include <linux/platform_device.h>
-+#include <linux/timer.h>
-+
-+#include <asm/arch/hardware.h>
-+
-+#include <asm/arch/h3600.h>
-+#include <asm/arch/SA-1100.h>
-+
-+#include <asm/hardware/micro.h>
-+
-+#define BATT_PERIOD 10*HZ
-+
-+#define H3600_BATT_STATUS_HIGH         0x01
-+#define H3600_BATT_STATUS_LOW          0x02
-+#define H3600_BATT_STATUS_CRITICAL     0x04
-+#define H3600_BATT_STATUS_CHARGING     0x08
-+#define H3600_BATT_STATUS_CHARGEMAIN   0x10
-+#define H3600_BATT_STATUS_DEAD         0x20 /* Battery will not charge */
-+#define H3600_BATT_STATUS_NOTINSTALLED 0x20 /* For expansion pack batteries */
-+#define H3600_BATT_STATUS_FULL         0x40 /* Battery fully charged (and connected to AC) */
-+#define H3600_BATT_STATUS_NOBATTERY    0x80
-+#define H3600_BATT_STATUS_UNKNOWN      0xff
-+
-+
-+//static struct power_supply_dev *micro_battery;
-+
-+static micro_private_t *p_micro;
-+
-+struct timer_list batt_timer;
-+
-+struct {
-+       int ac;
-+       int update_time;
-+       int chemistry;
-+       int voltage;
-+       int temperature;
-+       int flag;
-+} micro_battery;
-+
-+static void micro_battery_receive (int len, unsigned char *data) {
-+       if (0) {
-+               printk(KERN_ERR "h3600_battery - AC = %02x\n", data[0]);
-+               printk(KERN_ERR "h3600_battery - BAT1 chemistry = %02x\n", data[1]);
-+               printk(KERN_ERR "h3600_battery - BAT1 voltage = %d %02x%02x\n", (data[3]<<8)+data[2], data[2], data[3]);
-+               printk(KERN_ERR "h3600_battery - BAT1 status = %02x\n", data[4]);
-+       }
-+
-+       micro_battery.ac = data[0];
-+       micro_battery.chemistry = data[1];
-+       micro_battery.voltage = ((((unsigned short)data[3]<<8)+data[2]) * 5000L ) * 1000 / 1024;
-+       micro_battery.flag = data[4];
-+
-+       if (len == 9) {
-+               if (0) {
-+                       printk(KERN_ERR "h3600_battery - BAT2 chemistry = %02x\n", data[5]);
-+                       printk(KERN_ERR "h3600_battery - BAT2 voltage = %d %02x%02x\n", (data[7]<<8)+data[6], data[6], data[7]);
-+                       printk(KERN_ERR "h3600_battery - BAT2 status = %02x\n", data[8]);
-+               }
-+       }
-+}
-+
-+static void micro_temperature_receive (int len, unsigned char *data) {
-+       micro_battery.temperature = ((unsigned short)data[1]<<8)+data[0];
-+}
-+
-+void h3600_battery_read_status(unsigned long data) {
-+
-+       if (++data % 2)
-+               h3600_micro_tx_msg(0x09,0,NULL);
-+       else
-+               h3600_micro_tx_msg(0x06,0,NULL);
-+
-+       batt_timer.expires += BATT_PERIOD;
-+       batt_timer.data = data;
-+
-+       add_timer(&batt_timer);
-+}
-+
-+int get_capacity(struct power_supply *b) {
-+    switch (micro_battery.flag) {
-+    case H3600_BATT_STATUS_HIGH :     return 100; break;
-+    case H3600_BATT_STATUS_LOW :      return 50; break;
-+    case H3600_BATT_STATUS_CRITICAL : return 5; break;
-+    default: break;
-+    }
-+    return 0;
-+}
-+
-+int get_status(struct power_supply *b) {
-+
-+   if (micro_battery.flag == H3600_BATT_STATUS_UNKNOWN)
-+      return POWER_SUPPLY_STATUS_UNKNOWN;
-+
-+   if (micro_battery.flag & H3600_BATT_STATUS_FULL)
-+      return POWER_SUPPLY_STATUS_FULL;
-+
-+   if ((micro_battery.flag & H3600_BATT_STATUS_CHARGING) ||
-+       (micro_battery.flag & H3600_BATT_STATUS_CHARGEMAIN))
-+      return POWER_SUPPLY_STATUS_CHARGING;
-+
-+   return POWER_SUPPLY_STATUS_DISCHARGING;
-+}
-+
-+static int micro_batt_get_property(struct power_supply *b,
-+                                   enum power_supply_property psp,
-+                                   union power_supply_propval *val)
-+{
-+       switch (psp) {
-+       case POWER_SUPPLY_PROP_STATUS:
-+               val->intval = get_status(b);
-+               break;
-+       case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN:
-+               val->intval = 4700000;
-+               break;
-+       case POWER_SUPPLY_PROP_CAPACITY:
-+               val->intval = get_capacity(b);
-+               break;
-+       case POWER_SUPPLY_PROP_TEMP:
-+               val->intval = micro_battery.temperature;
-+               break;
-+       case POWER_SUPPLY_PROP_VOLTAGE_NOW:
-+               val->intval = micro_battery.voltage;
-+               break;
-+       default:
-+               return -EINVAL;
-+       };
-+
-+       return 0;
-+}
-+
-+static enum power_supply_property micro_batt_props[] = {
-+       POWER_SUPPLY_PROP_STATUS,
-+       POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN,
-+       POWER_SUPPLY_PROP_CAPACITY,
-+       POWER_SUPPLY_PROP_TEMP,
-+       POWER_SUPPLY_PROP_VOLTAGE_NOW,
-+};
-+
-+static struct power_supply h3600_battery = {
-+       .name               = "main-battery",
-+       .properties         = micro_batt_props,
-+       .num_properties     = ARRAY_SIZE(micro_batt_props),
-+       .get_property       = micro_batt_get_property,
-+       .use_for_apm        = 1,
-+};
-+
-+static int micro_batt_probe (struct platform_device *pdev)
-+{
-+       if (1) printk(KERN_ERR "micro battery probe : begin\n");
-+
-+       power_supply_register(&pdev->dev, &h3600_battery);
-+
-+       { /*--- callback ---*/
-+               p_micro = platform_get_drvdata(pdev);
-+               spin_lock(p_micro->lock);
-+               p_micro->h_batt = micro_battery_receive;
-+               p_micro->h_temp = micro_temperature_receive;
-+               spin_unlock(p_micro->lock);
-+       }
-+
-+       { /*--- timer ---*/
-+               init_timer(&batt_timer);
-+               batt_timer.expires = jiffies + BATT_PERIOD;
-+               batt_timer.data = 0;
-+               batt_timer.function = h3600_battery_read_status;
-+
-+               add_timer(&batt_timer);
-+       }
-+
-+       if (1) printk(KERN_ERR "micro battery probe : end\n");
-+       return 0;
-+}
-+
-+static int micro_batt_remove (struct platform_device *pdev)
-+{
-+       power_supply_unregister(&h3600_battery);
-+       { /*--- callback ---*/
-+               init_timer(&batt_timer);
-+               p_micro->h_batt = NULL;
-+               p_micro->h_temp = NULL;
-+               spin_unlock(p_micro->lock);
-+       }
-+       { /*--- timer ---*/
-+               del_timer_sync(&batt_timer);
-+       }
-+        return 0;
-+}
-+
-+static int micro_batt_suspend ( struct platform_device *pdev, pm_message_t state)
-+{
-+       { /*--- timer ---*/
-+               del_timer(&batt_timer);
-+       }
-+       return 0;
-+}
-+
-+static int micro_batt_resume ( struct platform_device *pdev)
-+{
-+       { /*--- timer ---*/
-+               add_timer(&batt_timer);
-+       }
-+       return 0;
-+}
-+
-+struct platform_driver micro_batt_device_driver = {
-+       .driver  = {
-+               .name    = "h3600-micro-battery",
-+       },
-+       .probe   = micro_batt_probe,
-+       .remove  = micro_batt_remove,
-+       .suspend = micro_batt_suspend,
-+       .resume  = micro_batt_resume,
-+};
-+
-+static int micro_batt_init (void)
-+{
-+       return platform_driver_register(&micro_batt_device_driver);
-+}
-+
-+static void micro_batt_cleanup (void)
-+{
-+       platform_driver_unregister (&micro_batt_device_driver);
-+}
-+
-+module_init (micro_batt_init);
-+module_exit (micro_batt_cleanup);
-+
-+MODULE_LICENSE("GPL");
-+MODULE_AUTHOR("gremlin.it");
-+MODULE_DESCRIPTION("driver for iPAQ Atmel micro battery");
-+
-+
-Index: linux-2.6.22/drivers/power/olpc_battery.c
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/olpc_battery.c   2007-08-23 12:13:52.000000000 +0200
-@@ -0,0 +1,302 @@
-+/*
-+ * Battery driver for One Laptop Per Child board.
-+ *
-+ *     Copyright © 2006  David Woodhouse <dwmw2@infradead.org>
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+
-+#include <linux/module.h>
-+#include <linux/err.h>
-+#include <linux/platform_device.h>
-+#include <linux/power_supply.h>
-+#include <linux/jiffies.h>
-+#include <linux/sched.h>
-+#include <asm/io.h>
-+
-+#define wBAT_VOLTAGE     0xf900  /* *9.76/32,    mV   */
-+#define wBAT_CURRENT     0xf902  /* *15.625/120, mA   */
-+#define wBAT_TEMP        0xf906  /* *256/1000,   °C  */
-+#define wAMB_TEMP        0xf908  /* *256/1000,   °C  */
-+#define SOC              0xf910  /* percentage        */
-+#define sMBAT_STATUS     0xfaa4
-+#define sBAT_PRESENT          1
-+#define sBAT_FULL             2
-+#define sBAT_DESTROY          4  /* what is this exactly? */
-+#define sBAT_LOW             32
-+#define sBAT_DISCHG          64
-+#define sMCHARGE_STATUS  0xfaa5
-+#define sBAT_CHARGE           1
-+#define sBAT_OVERTEMP         4
-+#define sBAT_NiMH             8
-+#define sPOWER_FLAG      0xfa40
-+#define ADAPTER_IN            1
-+
-+/*********************************************************************
-+ *             EC locking and access
-+ *********************************************************************/
-+
-+static int lock_ec(void)
-+{
-+       unsigned long timeo = jiffies + HZ / 20;
-+
-+       while (1) {
-+               unsigned char lock = inb(0x6c) & 0x80;
-+               if (!lock)
-+                       return 0;
-+               if (time_after(jiffies, timeo)) {
-+                       printk(KERN_ERR "olpc_battery: failed to lock EC for "
-+                              "battery access\n");
-+                       return 1;
-+               }
-+               yield();
-+       }
-+}
-+
-+static void unlock_ec(void)
-+{
-+       outb(0xff, 0x6c);
-+       return;
-+}
-+
-+static unsigned char read_ec_byte(unsigned short adr)
-+{
-+       outb(adr >> 8, 0x381);
-+       outb(adr, 0x382);
-+       return inb(0x383);
-+}
-+
-+static unsigned short read_ec_word(unsigned short adr)
-+{
-+       return (read_ec_byte(adr) << 8) | read_ec_byte(adr + 1);
-+}
-+
-+/*********************************************************************
-+ *             Power
-+ *********************************************************************/
-+
-+static int olpc_ac_get_prop(struct power_supply *psy,
-+                            enum power_supply_property psp,
-+                            union power_supply_propval *val)
-+{
-+       int ret = 0;
-+
-+       if (lock_ec())
-+               return -EIO;
-+
-+       switch (psp) {
-+       case POWER_SUPPLY_PROP_ONLINE:
-+               if (!(read_ec_byte(sMBAT_STATUS) & sBAT_PRESENT)) {
-+                       ret = -ENODEV;
-+                       goto out;
-+               }
-+               val->intval = !!(read_ec_byte(sPOWER_FLAG) & ADAPTER_IN);
-+               break;
-+       default:
-+               ret = -EINVAL;
-+               break;
-+       }
-+out:
-+       unlock_ec();
-+       return ret;
-+}
-+
-+static enum power_supply_property olpc_ac_props[] = {
-+       POWER_SUPPLY_PROP_ONLINE,
-+};
-+
-+static struct power_supply olpc_ac = {
-+       .name = "olpc-ac",
-+       .type = POWER_SUPPLY_TYPE_MAINS,
-+       .properties = olpc_ac_props,
-+       .num_properties = ARRAY_SIZE(olpc_ac_props),
-+       .get_property = olpc_ac_get_prop,
-+};
-+
-+/*********************************************************************
-+ *             Battery properties
-+ *********************************************************************/
-+
-+static int olpc_bat_get_property(struct power_supply *psy,
-+                                 enum power_supply_property psp,
-+                                 union power_supply_propval *val)
-+{
-+       int ret = 0;
-+
-+       if (lock_ec())
-+               return -EIO;
-+
-+       switch (psp) {
-+       case POWER_SUPPLY_PROP_STATUS:
-+               {
-+                       int status = POWER_SUPPLY_STATUS_UNKNOWN;
-+
-+                       val->intval = read_ec_byte(sMBAT_STATUS);
-+
-+                       if (!(val->intval & sBAT_PRESENT)) {
-+                               ret = -ENODEV;
-+                               goto out;
-+                       }
-+
-+                       if (val->intval & sBAT_DISCHG)
-+                               status = POWER_SUPPLY_STATUS_DISCHARGING;
-+                       else if (val->intval & sBAT_FULL)
-+                               status = POWER_SUPPLY_STATUS_FULL;
-+
-+                       val->intval = read_ec_byte(sMCHARGE_STATUS);
-+                       if (val->intval & sBAT_CHARGE)
-+                               status = POWER_SUPPLY_STATUS_CHARGING;
-+
-+                       val->intval = status;
-+                       break;
-+               }
-+       case POWER_SUPPLY_PROP_PRESENT:
-+               val->intval = !!(read_ec_byte(sMBAT_STATUS) & sBAT_PRESENT);
-+               break;
-+       case POWER_SUPPLY_PROP_HEALTH:
-+               val->intval = read_ec_byte(sMCHARGE_STATUS);
-+               if (val->intval & sBAT_OVERTEMP)
-+                       val->intval = POWER_SUPPLY_HEALTH_OVERHEAT;
-+               else
-+                       val->intval = POWER_SUPPLY_HEALTH_GOOD;
-+               break;
-+       case POWER_SUPPLY_PROP_TECHNOLOGY:
-+               val->intval = read_ec_byte(sMCHARGE_STATUS);
-+               if (val->intval & sBAT_NiMH)
-+                       val->intval = POWER_SUPPLY_TECHNOLOGY_NIMH;
-+               else
-+                       val->intval = POWER_SUPPLY_TECHNOLOGY_UNKNOWN;
-+               break;
-+       case POWER_SUPPLY_PROP_VOLTAGE_AVG:
-+               val->intval = read_ec_byte(wBAT_VOLTAGE) * 9760L / 32;
-+               break;
-+       case POWER_SUPPLY_PROP_CURRENT_AVG:
-+               val->intval = read_ec_byte(wBAT_CURRENT) * 15625L / 120;
-+               break;
-+       case POWER_SUPPLY_PROP_CAPACITY:
-+               val->intval = read_ec_byte(SOC);
-+               break;
-+       case POWER_SUPPLY_PROP_CAPACITY_LEVEL:
-+               val->intval = read_ec_byte(sMBAT_STATUS);
-+               if (val->intval & sBAT_FULL)
-+                       val->intval = POWER_SUPPLY_CAPACITY_LEVEL_FULL;
-+               else if (val->intval & sBAT_LOW)
-+                       val->intval = POWER_SUPPLY_CAPACITY_LEVEL_LOW;
-+               else
-+                       val->intval = POWER_SUPPLY_CAPACITY_LEVEL_NORMAL;
-+               break;
-+       case POWER_SUPPLY_PROP_TEMP:
-+               val->intval = read_ec_byte(wBAT_TEMP) * 256 / 100;
-+               break;
-+       case POWER_SUPPLY_PROP_TEMP_AMBIENT:
-+               val->intval = read_ec_byte(wAMB_TEMP) * 256 / 100;
-+               break;
-+       default:
-+               ret = -EINVAL;
-+               break;
-+       }
-+
-+out:
-+       unlock_ec();
-+       return ret;
-+}
-+
-+static enum power_supply_property olpc_bat_props[] = {
-+       POWER_SUPPLY_PROP_STATUS,
-+       POWER_SUPPLY_PROP_PRESENT,
-+       POWER_SUPPLY_PROP_HEALTH,
-+       POWER_SUPPLY_PROP_TECHNOLOGY,
-+       POWER_SUPPLY_PROP_VOLTAGE_AVG,
-+       POWER_SUPPLY_PROP_CURRENT_AVG,
-+       POWER_SUPPLY_PROP_CAPACITY,
-+       POWER_SUPPLY_PROP_CAPACITY_LEVEL,
-+       POWER_SUPPLY_PROP_TEMP,
-+       POWER_SUPPLY_PROP_TEMP_AMBIENT,
-+};
-+
-+/*********************************************************************
-+ *             Initialisation
-+ *********************************************************************/
-+
-+static struct platform_device *bat_pdev;
-+
-+static struct power_supply olpc_bat = {
-+       .properties = olpc_bat_props,
-+       .num_properties = ARRAY_SIZE(olpc_bat_props),
-+       .get_property = olpc_bat_get_property,
-+       .use_for_apm = 1,
-+};
-+
-+static int __init olpc_bat_init(void)
-+{
-+       int ret = 0;
-+       unsigned short tmp;
-+
-+       if (!request_region(0x380, 4, "olpc-battery")) {
-+               ret = -EIO;
-+               goto region_failed;
-+       }
-+
-+       if (lock_ec()) {
-+               ret = -EIO;
-+               goto lock_failed;
-+       }
-+
-+       tmp = read_ec_word(0xfe92);
-+       unlock_ec();
-+
-+       if (tmp != 0x380) {
-+               /* Doesn't look like OLPC EC */
-+               ret = -ENODEV;
-+               goto not_olpc_ec;
-+       }
-+
-+       bat_pdev = platform_device_register_simple("olpc-battery", 0, NULL, 0);
-+       if (IS_ERR(bat_pdev)) {
-+               ret = PTR_ERR(bat_pdev);
-+               goto pdev_failed;
-+       }
-+
-+       ret = power_supply_register(&bat_pdev->dev, &olpc_ac);
-+       if (ret)
-+               goto ac_failed;
-+
-+       olpc_bat.name = bat_pdev->name;
-+
-+       ret = power_supply_register(&bat_pdev->dev, &olpc_bat);
-+       if (ret)
-+               goto battery_failed;
-+
-+       goto success;
-+
-+battery_failed:
-+       power_supply_unregister(&olpc_ac);
-+ac_failed:
-+       platform_device_unregister(bat_pdev);
-+pdev_failed:
-+not_olpc_ec:
-+lock_failed:
-+       release_region(0x380, 4);
-+region_failed:
-+success:
-+       return ret;
-+}
-+
-+static void __exit olpc_bat_exit(void)
-+{
-+       power_supply_unregister(&olpc_bat);
-+       power_supply_unregister(&olpc_ac);
-+       platform_device_unregister(bat_pdev);
-+       release_region(0x380, 4);
-+       return;
-+}
-+
-+module_init(olpc_bat_init);
-+module_exit(olpc_bat_exit);
-+
-+MODULE_AUTHOR("David Woodhouse <dwmw2@infradead.org>");
-+MODULE_LICENSE("GPL");
-+MODULE_DESCRIPTION("Battery driver for One Laptop Per Child "
-+                   "($100 laptop) board.");
-Index: linux-2.6.22/drivers/power/pda_power.c
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/pda_power.c      2007-08-23 12:13:52.000000000 +0200
-@@ -0,0 +1,263 @@
-+/*
-+ * Common power driver for PDAs and phones with one or two external
-+ * power supplies (AC/USB) connected to main and backup batteries,
-+ * and optional builtin charger.
-+ *
-+ * Copyright 2007 Anton Vorontsov <cbou@mail.ru>
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+
-+#include <linux/module.h>
-+#include <linux/platform_device.h>
-+#include <linux/interrupt.h>
-+#include <linux/power_supply.h>
-+#include <linux/pda_power.h>
-+#include <linux/timer.h>
-+#include <linux/jiffies.h>
-+
-+static inline unsigned int get_irq_flags(struct resource *res)
-+{
-+       unsigned int flags = IRQF_DISABLED | IRQF_SHARED;
-+
-+       flags |= res->flags & IRQF_TRIGGER_MASK;
-+
-+       return flags;
-+}
-+
-+static struct device *dev;
-+static struct pda_power_pdata *pdata;
-+static struct resource *ac_irq, *usb_irq;
-+static struct timer_list charger_timer;
-+static struct timer_list supply_timer;
-+
-+static int pda_power_get_property(struct power_supply *psy,
-+                                  enum power_supply_property psp,
-+                                  union power_supply_propval *val)
-+{
-+       switch (psp) {
-+       case POWER_SUPPLY_PROP_ONLINE:
-+               if (psy->type == POWER_SUPPLY_TYPE_MAINS)
-+                       val->intval = pdata->is_ac_online ?
-+                                     pdata->is_ac_online() : 0;
-+               else
-+                       val->intval = pdata->is_usb_online ?
-+                                     pdata->is_usb_online() : 0;
-+               break;
-+       default:
-+               return -EINVAL;
-+       }
-+       return 0;
-+}
-+
-+static enum power_supply_property pda_power_props[] = {
-+       POWER_SUPPLY_PROP_ONLINE,
-+};
-+
-+static char *pda_power_supplied_to[] = {
-+       "main-battery",
-+       "backup-battery",
-+};
-+
-+static struct power_supply pda_power_supplies[] = {
-+       {
-+               .name = "ac",
-+               .type = POWER_SUPPLY_TYPE_MAINS,
-+               .supplied_to = pda_power_supplied_to,
-+               .num_supplicants = ARRAY_SIZE(pda_power_supplied_to),
-+               .properties = pda_power_props,
-+               .num_properties = ARRAY_SIZE(pda_power_props),
-+               .get_property = pda_power_get_property,
-+       },
-+       {
-+               .name = "usb",
-+               .type = POWER_SUPPLY_TYPE_USB,
-+               .supplied_to = pda_power_supplied_to,
-+               .num_supplicants = ARRAY_SIZE(pda_power_supplied_to),
-+               .properties = pda_power_props,
-+               .num_properties = ARRAY_SIZE(pda_power_props),
-+               .get_property = pda_power_get_property,
-+       },
-+};
-+
-+static void update_charger(void)
-+{
-+       if (!pdata->set_charge)
-+               return;
-+
-+       if (pdata->is_ac_online && pdata->is_ac_online()) {
-+               dev_dbg(dev, "charger on (AC)\n");
-+               pdata->set_charge(PDA_POWER_CHARGE_AC);
-+       }
-+       else if (pdata->is_usb_online && pdata->is_usb_online()) {
-+               dev_dbg(dev, "charger on (USB)\n");
-+               pdata->set_charge(PDA_POWER_CHARGE_USB);
-+       }
-+       else {
-+               dev_dbg(dev, "charger off\n");
-+               pdata->set_charge(0);
-+       }
-+
-+       return;
-+}
-+
-+static void supply_timer_func(unsigned long irq)
-+{
-+       if (ac_irq && irq == ac_irq->start)
-+               power_supply_changed(&pda_power_supplies[0]);
-+       else if (usb_irq && irq == usb_irq->start)
-+               power_supply_changed(&pda_power_supplies[1]);
-+       return;
-+}
-+
-+static void charger_timer_func(unsigned long irq)
-+{
-+       update_charger();
-+
-+       /* Okay, charger set. Now wait a bit before notifying supplicants,
-+        * charge power should stabilize. */
-+       supply_timer.data = irq;
-+       mod_timer(&supply_timer,
-+                 jiffies + msecs_to_jiffies(pdata->wait_for_charger));
-+       return;
-+}
-+
-+static irqreturn_t power_changed_isr(int irq, void *unused)
-+{
-+       /* Wait a bit before reading ac/usb line status and setting charger,
-+        * because ac/usb status readings may lag from irq. */
-+       charger_timer.data = irq;
-+       mod_timer(&charger_timer,
-+                 jiffies + msecs_to_jiffies(pdata->wait_for_status));
-+       return IRQ_HANDLED;
-+}
-+
-+static int pda_power_probe(struct platform_device *pdev)
-+{
-+       int ret = 0;
-+
-+       dev = &pdev->dev;
-+
-+       if (pdev->id != -1) {
-+               dev_err(dev, "it's meaningless to register several "
-+                       "pda_powers, use id = -1\n");
-+               ret = -EINVAL;
-+               goto wrongid;
-+       }
-+
-+       pdata = pdev->dev.platform_data;
-+
-+       update_charger();
-+
-+       if (!pdata->wait_for_status)
-+               pdata->wait_for_status = 500;
-+
-+       if (!pdata->wait_for_charger)
-+               pdata->wait_for_charger = 500;
-+
-+       setup_timer(&charger_timer, charger_timer_func, 0);
-+       setup_timer(&supply_timer, supply_timer_func, 0);
-+
-+       ac_irq = platform_get_resource_byname(pdev, IORESOURCE_IRQ, "ac");
-+       usb_irq = platform_get_resource_byname(pdev, IORESOURCE_IRQ, "usb");
-+       if (!ac_irq && !usb_irq) {
-+               dev_err(dev, "no ac/usb irq specified\n");
-+               ret = -ENODEV;
-+               goto noirqs;
-+       }
-+
-+       if (pdata->supplied_to) {
-+               pda_power_supplies[0].supplied_to = pdata->supplied_to;
-+               pda_power_supplies[1].supplied_to = pdata->supplied_to;
-+               pda_power_supplies[0].num_supplicants = pdata->num_supplicants;
-+               pda_power_supplies[1].num_supplicants = pdata->num_supplicants;
-+       }
-+
-+       ret = power_supply_register(&pdev->dev, &pda_power_supplies[0]);
-+       if (ret) {
-+               dev_err(dev, "failed to register %s power supply\n",
-+                       pda_power_supplies[0].name);
-+               goto supply0_failed;
-+       }
-+
-+       ret = power_supply_register(&pdev->dev, &pda_power_supplies[1]);
-+       if (ret) {
-+               dev_err(dev, "failed to register %s power supply\n",
-+                       pda_power_supplies[1].name);
-+               goto supply1_failed;
-+       }
-+
-+       if (ac_irq) {
-+               ret = request_irq(ac_irq->start, power_changed_isr,
-+                                 get_irq_flags(ac_irq), ac_irq->name,
-+                                 &pda_power_supplies[0]);
-+               if (ret) {
-+                       dev_err(dev, "request ac irq failed\n");
-+                       goto ac_irq_failed;
-+               }
-+       }
-+
-+       if (usb_irq) {
-+               ret = request_irq(usb_irq->start, power_changed_isr,
-+                                 get_irq_flags(usb_irq), usb_irq->name,
-+                                 &pda_power_supplies[1]);
-+               if (ret) {
-+                       dev_err(dev, "request usb irq failed\n");
-+                       goto usb_irq_failed;
-+               }
-+       }
-+
-+       goto success;
-+
-+usb_irq_failed:
-+       if (ac_irq)
-+               free_irq(ac_irq->start, &pda_power_supplies[0]);
-+ac_irq_failed:
-+       power_supply_unregister(&pda_power_supplies[1]);
-+supply1_failed:
-+       power_supply_unregister(&pda_power_supplies[0]);
-+supply0_failed:
-+noirqs:
-+wrongid:
-+success:
-+       return ret;
-+}
-+
-+static int pda_power_remove(struct platform_device *pdev)
-+{
-+       if (usb_irq)
-+               free_irq(usb_irq->start, &pda_power_supplies[1]);
-+       if (ac_irq)
-+               free_irq(ac_irq->start, &pda_power_supplies[0]);
-+       del_timer_sync(&charger_timer);
-+       del_timer_sync(&supply_timer);
-+       power_supply_unregister(&pda_power_supplies[1]);
-+       power_supply_unregister(&pda_power_supplies[0]);
-+       return 0;
-+}
-+
-+static struct platform_driver pda_power_pdrv = {
-+       .driver = {
-+               .name = "pda-power",
-+       },
-+       .probe = pda_power_probe,
-+       .remove = pda_power_remove,
-+};
-+
-+static int __init pda_power_init(void)
-+{
-+       return platform_driver_register(&pda_power_pdrv);
-+}
-+
-+static void __exit pda_power_exit(void)
-+{
-+       platform_driver_unregister(&pda_power_pdrv);
-+       return;
-+}
-+
-+module_init(pda_power_init);
-+module_exit(pda_power_exit);
-+MODULE_LICENSE("GPL");
-+MODULE_AUTHOR("Anton Vorontsov <cbou@mail.ru>");
-Index: linux-2.6.22/drivers/power/pmu_battery.c
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/pmu_battery.c    2007-08-23 12:13:52.000000000 +0200
-@@ -0,0 +1,215 @@
-+/*
-+ * Battery class driver for Apple PMU
-+ *
-+ *     Copyright © 2006  David Woodhouse <dwmw2@infradead.org>
-+ *
-+ * This program is free software; you can redistribute it and/or modify
-+ * it under the terms of the GNU General Public License version 2 as
-+ * published by the Free Software Foundation.
-+ */
-+
-+#include <linux/module.h>
-+#include <linux/platform_device.h>
-+#include <linux/err.h>
-+#include <linux/power_supply.h>
-+#include <linux/adb.h>
-+#include <linux/pmu.h>
-+
-+static struct pmu_battery_dev {
-+       struct power_supply bat;
-+       struct pmu_battery_info *pbi;
-+       char name[16];
-+       int propval;
-+} *pbats[PMU_MAX_BATTERIES];
-+
-+#define to_pmu_battery_dev(x) container_of(x, struct pmu_battery_dev, bat)
-+
-+/*********************************************************************
-+ *             Power
-+ *********************************************************************/
-+
-+static int pmu_get_ac_prop(struct power_supply *psy,
-+                           enum power_supply_property psp,
-+                           union power_supply_propval *val)
-+{
-+       switch (psp) {
-+       case POWER_SUPPLY_PROP_ONLINE:
-+               val->intval = (!!(pmu_power_flags & PMU_PWR_AC_PRESENT)) ||
-+                             (pmu_battery_count == 0);
-+               break;
-+       default:
-+               return -EINVAL;
-+       }
-+
-+       return 0;
-+}
-+
-+static enum power_supply_property pmu_ac_props[] = {
-+       POWER_SUPPLY_PROP_ONLINE,
-+};
-+
-+static struct power_supply pmu_ac = {
-+       .name = "pmu-ac",
-+       .type = POWER_SUPPLY_TYPE_MAINS,
-+       .properties = pmu_ac_props,
-+       .num_properties = ARRAY_SIZE(pmu_ac_props),
-+       .get_property = pmu_get_ac_prop,
-+};
-+
-+/*********************************************************************
-+ *             Battery properties
-+ *********************************************************************/
-+
-+static char *pmu_batt_types[] = {
-+       "Smart", "Comet", "Hooper", "Unknown"
-+};
-+
-+static char *pmu_bat_get_model_name(struct pmu_battery_info *pbi)
-+{
-+       switch (pbi->flags & PMU_BATT_TYPE_MASK) {
-+       case PMU_BATT_TYPE_SMART:
-+               return pmu_batt_types[0];
-+       case PMU_BATT_TYPE_COMET:
-+               return pmu_batt_types[1];
-+       case PMU_BATT_TYPE_HOOPER:
-+               return pmu_batt_types[2];
-+       default: break;
-+       }
-+       return pmu_batt_types[3];
-+}
-+
-+static int pmu_bat_get_property(struct power_supply *psy,
-+                                enum power_supply_property psp,
-+                                union power_supply_propval *val)
-+{
-+       struct pmu_battery_dev *pbat = to_pmu_battery_dev(psy);
-+       struct pmu_battery_info *pbi = pbat->pbi;
-+
-+       switch (psp) {
-+       case POWER_SUPPLY_PROP_STATUS:
-+               if (pbi->flags & PMU_BATT_CHARGING)
-+                       val->intval = POWER_SUPPLY_STATUS_CHARGING;
-+               else
-+                       val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
-+               break;
-+       case POWER_SUPPLY_PROP_PRESENT:
-+               val->intval = !!(pbi->flags & PMU_BATT_PRESENT);
-+               break;
-+       case POWER_SUPPLY_PROP_MODEL_NAME:
-+               val->strval = pmu_bat_get_model_name(pbi);
-+               break;
-+       case POWER_SUPPLY_PROP_ENERGY_AVG:
-+               val->intval = pbi->charge     * 1000; /* mWh -> µWh */
-+               break;
-+       case POWER_SUPPLY_PROP_ENERGY_FULL:
-+               val->intval = pbi->max_charge * 1000; /* mWh -> µWh */
-+               break;
-+       case POWER_SUPPLY_PROP_CURRENT_AVG:
-+               val->intval = pbi->amperage   * 1000; /* mA -> µA */
-+               break;
-+       case POWER_SUPPLY_PROP_VOLTAGE_AVG:
-+               val->intval = pbi->voltage    * 1000; /* mV -> µV */
-+               break;
-+       case POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG:
-+               val->intval = pbi->time_remaining;
-+               break;
-+       default:
-+               return -EINVAL;
-+       }
-+
-+       return 0;
-+}
-+
-+static enum power_supply_property pmu_bat_props[] = {
-+       POWER_SUPPLY_PROP_STATUS,
-+       POWER_SUPPLY_PROP_PRESENT,
-+       POWER_SUPPLY_PROP_MODEL_NAME,
-+       POWER_SUPPLY_PROP_ENERGY_AVG,
-+       POWER_SUPPLY_PROP_ENERGY_FULL,
-+       POWER_SUPPLY_PROP_CURRENT_AVG,
-+       POWER_SUPPLY_PROP_VOLTAGE_AVG,
-+       POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG,
-+};
-+
-+/*********************************************************************
-+ *             Initialisation
-+ *********************************************************************/
-+
-+static struct platform_device *bat_pdev;
-+
-+static int __init pmu_bat_init(void)
-+{
-+       int ret;
-+       int i;
-+
-+       bat_pdev = platform_device_register_simple("pmu-battery",
-+                                                  0, NULL, 0);
-+       if (IS_ERR(bat_pdev)) {
-+               ret = PTR_ERR(bat_pdev);
-+               goto pdev_register_failed;
-+       }
-+
-+       ret = power_supply_register(&bat_pdev->dev, &pmu_ac);
-+       if (ret)
-+               goto ac_register_failed;
-+
-+       for (i = 0; i < pmu_battery_count; i++) {
-+               struct pmu_battery_dev *pbat = kzalloc(sizeof(*pbat),
-+                                                      GFP_KERNEL);
-+               if (!pbat)
-+                       break;
-+
-+               sprintf(pbat->name, "PMU battery %d", i);
-+               pbat->bat.name = pbat->name;
-+               pbat->bat.properties = pmu_bat_props;
-+               pbat->bat.num_properties = ARRAY_SIZE(pmu_bat_props);
-+               pbat->bat.get_property = pmu_bat_get_property;
-+               pbat->pbi = &pmu_batteries[i];
-+
-+               ret = power_supply_register(&bat_pdev->dev, &pbat->bat);
-+               if (ret) {
-+                       kfree(pbat);
-+                       goto battery_register_failed;
-+               }
-+               pbats[i] = pbat;
-+       }
-+
-+       goto success;
-+
-+battery_register_failed:
-+       while (i--) {
-+               if (!pbats[i])
-+                       continue;
-+               power_supply_unregister(&pbats[i]->bat);
-+               kfree(pbats[i]);
-+       }
-+       power_supply_unregister(&pmu_ac);
-+ac_register_failed:
-+       platform_device_unregister(bat_pdev);
-+pdev_register_failed:
-+success:
-+       return ret;
-+}
-+
-+static void __exit pmu_bat_exit(void)
-+{
-+       int i;
-+
-+       for (i = 0; i < PMU_MAX_BATTERIES; i++) {
-+               if (!pbats[i])
-+                       continue;
-+               power_supply_unregister(&pbats[i]->bat);
-+               kfree(pbats[i]);
-+       }
-+       power_supply_unregister(&pmu_ac);
-+       platform_device_unregister(bat_pdev);
-+
-+       return;
-+}
-+
-+module_init(pmu_bat_init);
-+module_exit(pmu_bat_exit);
-+
-+MODULE_AUTHOR("David Woodhouse <dwmw2@infradead.org>");
-+MODULE_LICENSE("GPL");
-+MODULE_DESCRIPTION("PMU battery driver");
-Index: linux-2.6.22/drivers/power/power_supply_core.c
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/power_supply_core.c      2007-08-23 12:13:52.000000000 +0200
-@@ -0,0 +1,168 @@
-+/*
-+ *  Universal power supply monitor class
-+ *
-+ *  Copyright (c) 2007  Anton Vorontsov <cbou@mail.ru>
-+ *  Copyright (c) 2004  Szabolcs Gyurko
-+ *  Copyright (c) 2003  Ian Molton <spyro@f2s.com>
-+ *
-+ *  Modified: 2004, Oct     Szabolcs Gyurko
-+ *
-+ *  You may use this code as per GPL version 2
-+ */
-+
-+#include <linux/module.h>
-+#include <linux/types.h>
-+#include <linux/init.h>
-+#include <linux/device.h>
-+#include <linux/err.h>
-+#include <linux/power_supply.h>
-+#include "power_supply.h"
-+
-+struct class *power_supply_class;
-+
-+static void power_supply_changed_work(struct work_struct *work)
-+{
-+       struct power_supply *psy = container_of(work, struct power_supply,
-+                                               changed_work);
-+       int i;
-+
-+       dev_dbg(psy->dev, "%s\n", __FUNCTION__);
-+
-+       for (i = 0; i < psy->num_supplicants; i++) {
-+               struct device *dev;
-+
-+               down(&power_supply_class->sem);
-+               list_for_each_entry(dev, &power_supply_class->devices, node) {
-+                       struct power_supply *pst = dev_get_drvdata(dev);
-+
-+                       if (!strcmp(psy->supplied_to[i], pst->name)) {
-+                               if (pst->external_power_changed)
-+                                       pst->external_power_changed(pst);
-+                       }
-+               }
-+               up(&power_supply_class->sem);
-+       }
-+
-+       power_supply_update_leds(psy);
-+
-+       kobject_uevent(&psy->dev->kobj, KOBJ_CHANGE);
-+
-+       return;
-+}
-+
-+void power_supply_changed(struct power_supply *psy)
-+{
-+       dev_dbg(psy->dev, "%s\n", __FUNCTION__);
-+
-+       schedule_work(&psy->changed_work);
-+
-+       return;
-+}
-+
-+int power_supply_am_i_supplied(struct power_supply *psy)
-+{
-+       union power_supply_propval ret = {0,};
-+       struct device *dev;
-+
-+       down(&power_supply_class->sem);
-+       list_for_each_entry(dev, &power_supply_class->devices, node) {
-+               struct power_supply *epsy = dev_get_drvdata(dev);
-+               int i;
-+
-+               for (i = 0; i < epsy->num_supplicants; i++) {
-+                       if (!strcmp(epsy->supplied_to[i], psy->name)) {
-+                               if (epsy->get_property(epsy,
-+                                         POWER_SUPPLY_PROP_ONLINE, &ret))
-+                                       continue;
-+                               if (ret.intval)
-+                                       goto out;
-+                       }
-+               }
-+       }
-+out:
-+       up(&power_supply_class->sem);
-+
-+       dev_dbg(psy->dev, "%s %d\n", __FUNCTION__, ret.intval);
-+
-+       return ret.intval;
-+}
-+
-+int power_supply_register(struct device *parent, struct power_supply *psy)
-+{
-+       int rc = 0;
-+
-+       psy->dev = device_create(power_supply_class, parent, 0,
-+                                "%s", psy->name);
-+       if (IS_ERR(psy->dev)) {
-+               rc = PTR_ERR(psy->dev);
-+               goto dev_create_failed;
-+       }
-+
-+       dev_set_drvdata(psy->dev, psy);
-+
-+       INIT_WORK(&psy->changed_work, power_supply_changed_work);
-+
-+       rc = power_supply_create_attrs(psy);
-+       if (rc)
-+               goto create_attrs_failed;
-+
-+       rc = power_supply_create_triggers(psy);
-+       if (rc)
-+               goto create_triggers_failed;
-+
-+       power_supply_changed(psy);
-+
-+       goto success;
-+
-+create_triggers_failed:
-+       power_supply_remove_attrs(psy);
-+create_attrs_failed:
-+       device_unregister(psy->dev);
-+dev_create_failed:
-+success:
-+       return rc;
-+}
-+
-+void power_supply_unregister(struct power_supply *psy)
-+{
-+       flush_scheduled_work();
-+       power_supply_remove_triggers(psy);
-+       power_supply_remove_attrs(psy);
-+       device_unregister(psy->dev);
-+       return;
-+}
-+
-+static int __init power_supply_class_init(void)
-+{
-+       power_supply_class = class_create(THIS_MODULE, "power_supply");
-+
-+       if (IS_ERR(power_supply_class))
-+               return PTR_ERR(power_supply_class);
-+
-+       power_supply_class->dev_uevent = power_supply_uevent;
-+
-+       return 0;
-+}
-+
-+static void __exit power_supply_class_exit(void)
-+{
-+       class_destroy(power_supply_class);
-+       return;
-+}
-+
-+EXPORT_SYMBOL_GPL(power_supply_changed);
-+EXPORT_SYMBOL_GPL(power_supply_am_i_supplied);
-+EXPORT_SYMBOL_GPL(power_supply_register);
-+EXPORT_SYMBOL_GPL(power_supply_unregister);
-+
-+/* exported for the APM Power driver, APM emulation */
-+EXPORT_SYMBOL_GPL(power_supply_class);
-+
-+subsys_initcall(power_supply_class_init);
-+module_exit(power_supply_class_exit);
-+
-+MODULE_DESCRIPTION("Universal power supply monitor class");
-+MODULE_AUTHOR("Ian Molton <spyro@f2s.com>, "
-+              "Szabolcs Gyurko, "
-+              "Anton Vorontsov <cbou@mail.ru>");
-+MODULE_LICENSE("GPL");
-Index: linux-2.6.22/drivers/power/power_supply.h
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/power_supply.h   2007-08-23 12:13:52.000000000 +0200
-@@ -0,0 +1,42 @@
-+/*
-+ *  Functions private to power supply class
-+ *
-+ *  Copyright (c) 2007  Anton Vorontsov <cbou@mail.ru>
-+ *  Copyright (c) 2004  Szabolcs Gyurko
-+ *  Copyright (c) 2003  Ian Molton <spyro@f2s.com>
-+ *
-+ *  Modified: 2004, Oct     Szabolcs Gyurko
-+ *
-+ *  You may use this code as per GPL version 2
-+ */
-+
-+#ifdef CONFIG_SYSFS
-+
-+extern int power_supply_create_attrs(struct power_supply *psy);
-+extern void power_supply_remove_attrs(struct power_supply *psy);
-+extern int power_supply_uevent(struct device *dev, char **envp, int num_envp,
-+                               char *buffer, int buffer_size);
-+
-+#else
-+
-+static inline int power_supply_create_attrs(struct power_supply *psy)
-+{ return 0; }
-+static inline void power_supply_remove_attrs(struct power_supply *psy) {}
-+#define power_supply_uevent NULL
-+
-+#endif /* CONFIG_SYSFS */
-+
-+#ifdef CONFIG_LEDS_TRIGGERS
-+
-+extern void power_supply_update_leds(struct power_supply *psy);
-+extern int power_supply_create_triggers(struct power_supply *psy);
-+extern void power_supply_remove_triggers(struct power_supply *psy);
-+
-+#else
-+
-+static inline void power_supply_update_leds(struct power_supply *psy) {}
-+static inline int power_supply_create_triggers(struct power_supply *psy)
-+{ return 0; }
-+static inline void power_supply_remove_triggers(struct power_supply *psy) {}
-+
-+#endif /* CONFIG_LEDS_TRIGGERS */
-Index: linux-2.6.22/drivers/power/power_supply_leds.c
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/power_supply_leds.c      2007-08-23 12:13:52.000000000 +0200
-@@ -0,0 +1,188 @@
-+/*
-+ *  LEDs triggers for power supply class
-+ *
-+ *  Copyright (c) 2007  Anton Vorontsov <cbou@mail.ru>
-+ *  Copyright (c) 2004  Szabolcs Gyurko
-+ *  Copyright (c) 2003  Ian Molton <spyro@f2s.com>
-+ *
-+ *  Modified: 2004, Oct     Szabolcs Gyurko
-+ *
-+ *  You may use this code as per GPL version 2
-+ */
-+
-+#include <linux/power_supply.h>
-+
-+/* If we have hwtimer trigger, then use it to blink charging LED */
-+
-+#if defined(CONFIG_LEDS_TRIGGER_HWTIMER) ||                  \
-+               (defined(CONFIG_BATTERY_MODULE) &&            \
-+                defined(CONFIG_LEDS_TRIGGER_HWTIMER_MODULE))
-+       #define led_trigger_register_charging led_trigger_register_hwtimer
-+       #define led_trigger_unregister_charging led_trigger_unregister_hwtimer
-+#else
-+       #define led_trigger_register_charging led_trigger_register_simple
-+       #define led_trigger_unregister_charging led_trigger_unregister_simple
-+#endif
-+
-+/* Battery specific LEDs triggers. */
-+
-+static void power_supply_update_bat_leds(struct power_supply *psy)
-+{
-+       union power_supply_propval status;
-+
-+       if (psy->get_property(psy, POWER_SUPPLY_PROP_STATUS, &status))
-+               return;
-+
-+       dev_dbg(psy->dev, "%s %d\n", __FUNCTION__, status.intval);
-+
-+       switch(status.intval) {
-+       case POWER_SUPPLY_STATUS_FULL:
-+               led_trigger_event(psy->charging_full_trig, LED_FULL);
-+               led_trigger_event(psy->charging_trig, LED_OFF);
-+               led_trigger_event(psy->full_trig, LED_FULL);
-+               break;
-+       case POWER_SUPPLY_STATUS_CHARGING:
-+               led_trigger_event(psy->charging_full_trig, LED_FULL);
-+               led_trigger_event(psy->charging_trig, LED_FULL);
-+               led_trigger_event(psy->full_trig, LED_OFF);
-+               break;
-+       default:
-+               led_trigger_event(psy->charging_full_trig, LED_OFF);
-+               led_trigger_event(psy->charging_trig, LED_OFF);
-+               led_trigger_event(psy->full_trig, LED_OFF);
-+               break;
-+       }
-+
-+       return;
-+}
-+
-+static int power_supply_create_bat_triggers(struct power_supply *psy)
-+{
-+       int rc = 0;
-+
-+       psy->charging_full_trig_name = kmalloc(strlen(psy->name) +
-+                                 sizeof("-charging-or-full"), GFP_KERNEL);
-+       if (!psy->charging_full_trig_name)
-+               goto charging_full_failed;
-+
-+       psy->charging_trig_name = kmalloc(strlen(psy->name) +
-+                                         sizeof("-charging"), GFP_KERNEL);
-+       if (!psy->charging_trig_name)
-+               goto charging_failed;
-+
-+       psy->full_trig_name = kmalloc(strlen(psy->name) +
-+                                     sizeof("-full"), GFP_KERNEL);
-+       if (!psy->full_trig_name)
-+               goto full_failed;
-+
-+       strcpy(psy->charging_full_trig_name, psy->name);
-+       strcat(psy->charging_full_trig_name, "-charging-or-full");
-+       strcpy(psy->charging_trig_name, psy->name);
-+       strcat(psy->charging_trig_name, "-charging");
-+       strcpy(psy->full_trig_name, psy->name);
-+       strcat(psy->full_trig_name, "-full");
-+
-+       led_trigger_register_simple(psy->charging_full_trig_name,
-+                                   &psy->charging_full_trig);
-+       led_trigger_register_charging(psy->charging_trig_name,
-+                                     &psy->charging_trig);
-+       led_trigger_register_simple(psy->full_trig_name,
-+                                   &psy->full_trig);
-+
-+       goto success;
-+
-+full_failed:
-+       kfree(psy->charging_trig_name);
-+charging_failed:
-+       kfree(psy->charging_full_trig_name);
-+charging_full_failed:
-+       rc = -ENOMEM;
-+success:
-+       return rc;
-+}
-+
-+static void power_supply_remove_bat_triggers(struct power_supply *psy)
-+{
-+       led_trigger_unregister_simple(psy->charging_full_trig);
-+       led_trigger_unregister_charging(psy->charging_trig);
-+       led_trigger_unregister_simple(psy->full_trig);
-+       kfree(psy->full_trig_name);
-+       kfree(psy->charging_trig_name);
-+       kfree(psy->charging_full_trig_name);
-+       return;
-+}
-+
-+/* Generated power specific LEDs triggers. */
-+
-+static void power_supply_update_gen_leds(struct power_supply *psy)
-+{
-+       union power_supply_propval online;
-+
-+       if (psy->get_property(psy, POWER_SUPPLY_PROP_ONLINE, &online))
-+               return;
-+
-+       dev_dbg(psy->dev, "%s %d\n", __FUNCTION__, online.intval);
-+
-+       if (online.intval)
-+               led_trigger_event(psy->online_trig, LED_FULL);
-+       else
-+               led_trigger_event(psy->online_trig, LED_OFF);
-+
-+       return;
-+}
-+
-+static int power_supply_create_gen_triggers(struct power_supply *psy)
-+{
-+       int rc = 0;
-+
-+       psy->online_trig_name = kmalloc(strlen(psy->name) + sizeof("-online"),
-+                                       GFP_KERNEL);
-+       if (!psy->online_trig_name)
-+               goto online_failed;
-+
-+       strcpy(psy->online_trig_name, psy->name);
-+       strcat(psy->online_trig_name, "-online");
-+
-+       led_trigger_register_simple(psy->online_trig_name, &psy->online_trig);
-+
-+       goto success;
-+
-+online_failed:
-+       rc = -ENOMEM;
-+success:
-+       return rc;
-+}
-+
-+static void power_supply_remove_gen_triggers(struct power_supply *psy)
-+{
-+       led_trigger_unregister_simple(psy->online_trig);
-+       kfree(psy->online_trig_name);
-+       return;
-+}
-+
-+/* Choice what triggers to create&update. */
-+
-+void power_supply_update_leds(struct power_supply *psy)
-+{
-+       if (psy->type == POWER_SUPPLY_TYPE_BATTERY)
-+               power_supply_update_bat_leds(psy);
-+       else
-+               power_supply_update_gen_leds(psy);
-+       return;
-+}
-+
-+int power_supply_create_triggers(struct power_supply *psy)
-+{
-+       if (psy->type == POWER_SUPPLY_TYPE_BATTERY)
-+               return power_supply_create_bat_triggers(psy);
-+       return power_supply_create_gen_triggers(psy);
-+}
-+
-+void power_supply_remove_triggers(struct power_supply *psy)
-+{
-+       if (psy->type == POWER_SUPPLY_TYPE_BATTERY)
-+               power_supply_remove_bat_triggers(psy);
-+       else
-+               power_supply_remove_gen_triggers(psy);
-+       return;
-+}
-Index: linux-2.6.22/drivers/power/power_supply_sysfs.c
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/power_supply_sysfs.c     2007-08-23 12:13:52.000000000 +0200
-@@ -0,0 +1,289 @@
-+/*
-+ *  Sysfs interface for the universal power supply monitor class
-+ *
-+ *  Copyright ©  2007  David Woodhouse <dwmw2@infradead.org>
-+ *  Copyright (c) 2007  Anton Vorontsov <cbou@mail.ru>
-+ *  Copyright (c) 2004  Szabolcs Gyurko
-+ *  Copyright (c) 2003  Ian Molton <spyro@f2s.com>
-+ *
-+ *  Modified: 2004, Oct     Szabolcs Gyurko
-+ *
-+ *  You may use this code as per GPL version 2
-+ */
-+
-+#include <linux/ctype.h>
-+#include <linux/power_supply.h>
-+
-+/*
-+ * This is because the name "current" breaks the device attr macro.
-+ * The "current" word resolvs to "(get_current())" so instead of
-+ * "current" "(get_current())" appears in the sysfs.
-+ *
-+ * The source of this definition is the device.h which calls __ATTR
-+ * macro in sysfs.h which calls the __stringify macro.
-+ *
-+ * Only modification that the name is not tried to be resolved
-+ * (as a macro let's say).
-+ */
-+
-+#define POWER_SUPPLY_ATTR(_name)                                        \
-+{                                                                       \
-+       .attr = { .name = #_name, .mode = 0444, .owner = THIS_MODULE }, \
-+       .show = power_supply_show_property,                             \
-+       .store = NULL,                                                  \
-+}
-+
-+static struct device_attribute power_supply_attrs[];
-+
-+static ssize_t power_supply_show_property(struct device *dev,
-+                                          struct device_attribute *attr,
-+                                          char *buf) {
-+       static char *status_text[] = {
-+               "Unknown", "Charging", "Discharging", "Not charging", "Full"
-+       };
-+       static char *health_text[] = {
-+               "Unknown", "Good", "Overheat", "Dead"
-+       };
-+       static char *technology_text[] = {
-+               "Unknown", "NiMH", "Li-ion", "Li-poly"
-+       };
-+       static char *capacity_level_text[] = {
-+               "Unknown", "Critical", "Low", "Normal", "High", "Full"
-+       };
-+       ssize_t ret;
-+       struct power_supply *psy = dev_get_drvdata(dev);
-+       const ptrdiff_t off = attr - power_supply_attrs;
-+       union power_supply_propval value;
-+
-+       ret = psy->get_property(psy, off, &value);
-+
-+       if (ret < 0) {
-+               dev_err(dev, "driver failed to report `%s' property\n",
-+                       attr->attr.name);
-+               return ret;
-+       }
-+
-+       if (off == POWER_SUPPLY_PROP_STATUS)
-+               return sprintf(buf, "%s\n", status_text[value.intval]);
-+       else if (off == POWER_SUPPLY_PROP_HEALTH)
-+               return sprintf(buf, "%s\n", health_text[value.intval]);
-+       else if (off == POWER_SUPPLY_PROP_TECHNOLOGY)
-+               return sprintf(buf, "%s\n", technology_text[value.intval]);
-+       else if (off == POWER_SUPPLY_PROP_CAPACITY_LEVEL)
-+               return sprintf(buf, "%s\n",
-+                              capacity_level_text[value.intval]);
-+       else if (off == POWER_SUPPLY_PROP_MODEL_NAME)
-+               return sprintf(buf, "%s\n", value.strval);
-+
-+       return sprintf(buf, "%d\n", value.intval);
-+}
-+
-+/* Must be in the same order as POWER_SUPPLY_PROP_* */
-+static struct device_attribute power_supply_attrs[] = {
-+       /* Properties of type `int' */
-+       POWER_SUPPLY_ATTR(status),
-+       POWER_SUPPLY_ATTR(health),
-+       POWER_SUPPLY_ATTR(present),
-+       POWER_SUPPLY_ATTR(online),
-+       POWER_SUPPLY_ATTR(technology),
-+       POWER_SUPPLY_ATTR(voltage_max_design),
-+       POWER_SUPPLY_ATTR(voltage_min_design),
-+       POWER_SUPPLY_ATTR(voltage_now),
-+       POWER_SUPPLY_ATTR(voltage_avg),
-+       POWER_SUPPLY_ATTR(current_now),
-+       POWER_SUPPLY_ATTR(current_avg),
-+       POWER_SUPPLY_ATTR(charge_full_design),
-+       POWER_SUPPLY_ATTR(charge_empty_design),
-+       POWER_SUPPLY_ATTR(charge_full),
-+       POWER_SUPPLY_ATTR(charge_empty),
-+       POWER_SUPPLY_ATTR(charge_now),
-+       POWER_SUPPLY_ATTR(charge_avg),
-+       POWER_SUPPLY_ATTR(energy_full_design),
-+       POWER_SUPPLY_ATTR(energy_empty_design),
-+       POWER_SUPPLY_ATTR(energy_full),
-+       POWER_SUPPLY_ATTR(energy_empty),
-+       POWER_SUPPLY_ATTR(energy_now),
-+       POWER_SUPPLY_ATTR(energy_avg),
-+       POWER_SUPPLY_ATTR(capacity),
-+       POWER_SUPPLY_ATTR(capacity_level),
-+       POWER_SUPPLY_ATTR(temp),
-+       POWER_SUPPLY_ATTR(temp_ambient),
-+       POWER_SUPPLY_ATTR(time_to_empty_now),
-+       POWER_SUPPLY_ATTR(time_to_empty_avg),
-+       POWER_SUPPLY_ATTR(time_to_full_now),
-+       POWER_SUPPLY_ATTR(time_to_full_avg),
-+       /* Properties of type `const char *' */
-+       POWER_SUPPLY_ATTR(model_name),
-+};
-+
-+static ssize_t power_supply_show_static_attrs(struct device *dev,
-+                                              struct device_attribute *attr,
-+                                              char *buf) {
-+       static char *type_text[] = { "Battery", "UPS", "Mains", "USB" };
-+       struct power_supply *psy = dev_get_drvdata(dev);
-+
-+       return sprintf(buf, "%s\n", type_text[psy->type]);
-+}
-+
-+static struct device_attribute power_supply_static_attrs[] = {
-+       __ATTR(type, 0444, power_supply_show_static_attrs, NULL),
-+};
-+
-+int power_supply_create_attrs(struct power_supply *psy)
-+{
-+       int rc = 0;
-+       int i, j;
-+
-+       for (i = 0; i < ARRAY_SIZE(power_supply_static_attrs); i++) {
-+               rc = device_create_file(psy->dev,
-+                           &power_supply_static_attrs[i]);
-+               if (rc)
-+                       goto statics_failed;
-+       }
-+
-+       for (j = 0; j < psy->num_properties; j++) {
-+               rc = device_create_file(psy->dev,
-+                           &power_supply_attrs[psy->properties[j]]);
-+               if (rc)
-+                       goto dynamics_failed;
-+       }
-+
-+       goto succeed;
-+
-+dynamics_failed:
-+       while (j--)
-+               device_remove_file(psy->dev,
-+                          &power_supply_attrs[psy->properties[j]]);
-+statics_failed:
-+       while (i--)
-+               device_remove_file(psy->dev,
-+                          &power_supply_static_attrs[psy->properties[i]]);
-+succeed:
-+       return rc;
-+}
-+
-+void power_supply_remove_attrs(struct power_supply *psy)
-+{
-+       int i;
-+
-+       for (i = 0; i < ARRAY_SIZE(power_supply_static_attrs); i++)
-+               device_remove_file(psy->dev,
-+                           &power_supply_static_attrs[i]);
-+
-+       for (i = 0; i < psy->num_properties; i++)
-+               device_remove_file(psy->dev,
-+                           &power_supply_attrs[psy->properties[i]]);
-+
-+       return;
-+}
-+
-+static char *kstruprdup(const char *str, gfp_t gfp)
-+{
-+       char *ret, *ustr;
-+
-+       ustr = ret = kmalloc(strlen(str) + 1, gfp);
-+
-+       if (!ret)
-+               return NULL;
-+
-+       while (*str)
-+               *ustr++ = toupper(*str++);
-+
-+       *ustr = 0;
-+
-+       return ret;
-+}
-+
-+int power_supply_uevent(struct device *dev, char **envp, int num_envp,
-+                        char *buffer, int buffer_size)
-+{
-+       struct power_supply *psy = dev_get_drvdata(dev);
-+       int i = 0, length = 0, ret = 0, j;
-+       char *prop_buf;
-+       char *attrname;
-+
-+       dev_dbg(dev, "uevent\n");
-+
-+       if (!psy) {
-+               dev_dbg(dev, "No power supply yet\n");
-+               return ret;
-+       }
-+
-+       dev_dbg(dev, "POWER_SUPPLY_NAME=%s\n", psy->name);
-+
-+       ret = add_uevent_var(envp, num_envp, &i, buffer, buffer_size,
-+                            &length, "POWER_SUPPLY_NAME=%s", psy->name);
-+       if (ret)
-+               return ret;
-+
-+       prop_buf = (char *)get_zeroed_page(GFP_KERNEL);
-+       if (!prop_buf)
-+               return -ENOMEM;
-+
-+       for (j = 0; j < ARRAY_SIZE(power_supply_static_attrs); j++) {
-+               struct device_attribute *attr;
-+               char *line;
-+
-+               attr = &power_supply_static_attrs[j];
-+
-+               ret = power_supply_show_static_attrs(dev, attr, prop_buf);
-+               if (ret < 0)
-+                       goto out;
-+
-+               line = strchr(prop_buf, '\n');
-+               if (line)
-+                       *line = 0;
-+
-+               attrname = kstruprdup(attr->attr.name, GFP_KERNEL);
-+               if (!attrname) {
-+                       ret = -ENOMEM;
-+                       goto out;
-+               }
-+
-+               dev_dbg(dev, "Static prop %s=%s\n", attrname, prop_buf);
-+
-+               ret = add_uevent_var(envp, num_envp, &i, buffer, buffer_size,
-+                                    &length, "POWER_SUPPLY_%s=%s",
-+                                    attrname, prop_buf);
-+               kfree(attrname);
-+               if (ret)
-+                       goto out;
-+       }
-+
-+       dev_dbg(dev, "%zd dynamic props\n", psy->num_properties);
-+
-+       for (j = 0; j < psy->num_properties; j++) {
-+               struct device_attribute *attr;
-+               char *line;
-+
-+               attr = &power_supply_attrs[psy->properties[j]];
-+
-+               ret = power_supply_show_property(dev, attr, prop_buf);
-+               if (ret < 0)
-+                       goto out;
-+
-+               line = strchr(prop_buf, '\n');
-+               if (line)
-+                       *line = 0;
-+
-+               attrname = kstruprdup(attr->attr.name, GFP_KERNEL);
-+               if (!attrname) {
-+                       ret = -ENOMEM;
-+                       goto out;
-+               }
-+
-+               dev_dbg(dev, "prop %s=%s\n", attrname, prop_buf);
-+
-+               ret = add_uevent_var(envp, num_envp, &i, buffer, buffer_size,
-+                                    &length, "POWER_SUPPLY_%s=%s",
-+                                    attrname, prop_buf);
-+               kfree(attrname);
-+               if (ret)
-+                       goto out;
-+       }
-+
-+out:
-+       free_page((unsigned long)prop_buf);
-+
-+       return ret;
-+}
-Index: linux-2.6.22/drivers/power/simpad-battery.c
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/drivers/power/simpad-battery.c 2007-08-23 12:13:52.000000000 +0200
-@@ -0,0 +1,242 @@
-+/*
-+ *  linux/drivers/misc/simpad-battery.c
-+ *
-+ *  Copyright (C) 2005 Holger Hans Peter Freyther
-+ *  Copyright (C) 2001 Juergen Messerer
-+ *
-+ * 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.
-+ *
-+ * Read the Battery Level through the UCB1x00 chip. T-Sinuspad is
-+ * unsupported for now.
-+ *
-+ */
-+
-+#include <linux/battery.h>
-+#include <asm/dma.h>
-+#include "ucb1x00.h"
-+
-+
-+/*
-+ * Conversion from AD -> mV
-+ * 7.5V = 1023   7.3313mV/Digit
-+ *
-+ * 400 Units == 9.7V
-+ * a     = ADC value
-+ * 21    = ADC error
-+ * 12600 = Divident to get 2*7.3242
-+ * 860   = Divider to get 2*7.3242
-+ * 170   = Voltagedrop over
-+ */
-+#define CALIBRATE_BATTERY(a)   ((((a + 21)*12600)/860) + 170)
-+
-+/*
-+ * We have two types of batteries a small and a large one
-+ * To get the right value we to distinguish between those two
-+ * 450 Units == 15 V
-+ */
-+#define CALIBRATE_SUPPLY(a)   (((a) * 1500) / 45)
-+#define MIN_SUPPLY            12000 /* Less then 12V means no powersupply */
-+
-+/*
-+ * Charging Current
-+ * if value is >= 50 then charging is on
-+ */
-+#define CALIBRATE_CHARGING(a)    (((a)* 1000)/(152/4)))
-+
-+struct simpad_battery_t {
-+       struct battery  battery;
-+       struct ucb1x00* ucb;
-+
-+        /*
-+        * Variables for the values to one time support
-+        * T-Sinuspad as well
-+        */
-+       int min_voltage;
-+       int min_current;
-+       int min_charge;
-+
-+       int max_voltage;
-+       int max_current;
-+       int max_charge;
-+
-+       int min_supply;
-+       int charging_led_label;
-+       int charging_max_label;
-+       int batt_full;
-+       int batt_low;
-+       int batt_critical;
-+       int batt_empty;
-+};
-+
-+static int simpad_get_min_voltage(struct battery* _battery )
-+{
-+       struct simpad_battery_t* battery = (struct simpad_battery_t*)_battery;
-+       return  battery->min_voltage;
-+}
-+
-+static int simpad_get_min_current(struct battery* _battery)
-+{
-+       struct simpad_battery_t* battery = (struct simpad_battery_t*)_battery;
-+       return battery->min_current;
-+}
-+
-+static int simpad_get_min_charge(struct battery* _battery)
-+{
-+       struct simpad_battery_t* battery = (struct simpad_battery_t*)_battery;
-+       return battery->min_charge;
-+}
-+
-+static int simpad_get_max_voltage(struct battery* _battery)
-+{
-+       struct simpad_battery_t* battery = (struct simpad_battery_t*)_battery;
-+       return battery->max_voltage;
-+}
-+
-+static int simpad_get_max_current(struct battery* _battery)
-+{
-+       struct simpad_battery_t* battery = (struct simpad_battery_t*)_battery;
-+       return battery->max_current;
-+}
-+
-+static int simpad_get_max_charge(struct battery* _battery)
-+{
-+       struct simpad_battery_t* battery = (struct simpad_battery_t*)_battery;
-+       return battery->max_charge;
-+}
-+
-+static int simpad_get_temp(struct battery* _battery)
-+{
-+       return 0;
-+}
-+
-+static int simpad_get_voltage(struct battery* _battery)
-+{
-+       int val;
-+       struct simpad_battery_t* battery = (struct simpad_battery_t*)_battery;
-+
-+
-+       ucb1x00_adc_enable(battery->ucb);
-+       val = ucb1x00_adc_read(battery->ucb, UCB_ADC_INP_AD1, UCB_NOSYNC);
-+       ucb1x00_adc_disable(battery->ucb);
-+
-+       return CALIBRATE_BATTERY(val);
-+}
-+
-+static int simpad_get_current(struct battery* _battery)
-+{
-+       int val;
-+       struct simpad_battery_t* battery = (struct simpad_battery_t*)_battery;
-+
-+       ucb1x00_adc_enable(battery->ucb);
-+       val = ucb1x00_adc_read(battery->ucb, UCB_ADC_INP_AD3, UCB_NOSYNC);
-+       ucb1x00_adc_disable(battery->ucb);
-+
-+       return val;
-+}
-+
-+static int simpad_get_charge(struct battery* _battery)
-+{
-+       int val;
-+       struct simpad_battery_t* battery = (struct simpad_battery_t*)_battery;
-+
-+       ucb1x00_adc_enable(battery->ucb);
-+       val = ucb1x00_adc_read(battery->ucb, UCB_ADC_INP_AD2, UCB_NOSYNC);
-+       ucb1x00_adc_disable(battery->ucb);
-+
-+       return CALIBRATE_SUPPLY(val);
-+
-+}
-+
-+static int simpad_get_status(struct battery* _battery)
-+{
-+       struct simpad_battery_t* battery = (struct simpad_battery_t*)(_battery);
-+       int vcharger = simpad_get_voltage(_battery);
-+       int icharger = simpad_get_current(_battery);
-+
-+       int status = BATTERY_STATUS_UNKNOWN;
-+       if(icharger > battery->charging_led_label)
-+               status = BATTERY_STATUS_CHARGING;
-+       else if(vcharger > battery->min_supply)
-+               status = BATTERY_STATUS_NOT_CHARGING;
-+       else
-+               status = BATTERY_STATUS_DISCHARGING;
-+
-+       return status;
-+}
-+
-+static struct simpad_battery_t simpad_battery  = {
-+       .battery = {
-+               .get_min_voltage = simpad_get_min_voltage,
-+               .get_min_current = simpad_get_min_current,
-+               .get_min_charge  = simpad_get_min_charge,
-+               .get_max_voltage = simpad_get_max_voltage,
-+               .get_max_current = simpad_get_max_current,
-+               .get_max_charge  = simpad_get_max_charge,
-+               .get_temp        = simpad_get_temp,
-+               .get_voltage     = simpad_get_voltage,
-+               .get_current     = simpad_get_current,
-+               .get_charge      = simpad_get_charge,
-+               .get_status      = simpad_get_status,
-+       },
-+       .min_voltage = 0,
-+       .min_current = 0,
-+       .min_charge  = 0,
-+       .max_voltage = 0,
-+       .max_current = 0,
-+       .max_charge  = 0,
-+
-+       .min_supply         = 1200,
-+       .charging_led_label = 18,
-+       .charging_max_label = 265,
-+       .batt_full          = 8300,
-+       .batt_low           = 7300,
-+       .batt_critical      = 6800,
-+       .batt_empty         = 6500,
-+};
-+
-+
-+
-+/*
-+ * UCB glue code
-+ */
-+static int ucb1x00_battery_add(struct class_device *dev)
-+{
-+       struct ucb1x00 *ucb = classdev_to_ucb1x00(dev);
-+       simpad_battery.ucb  = ucb;
-+
-+       battery_class_register(&simpad_battery.battery);
-+
-+       return 0;
-+}
-+
-+static void ucb1x00_battery_remove(struct class_device *dev)
-+{
-+       return battery_class_unregister(&simpad_battery.battery);
-+}
-+
-+
-+static struct ucb1x00_class_interface ucb1x00_battery_interface = {
-+       .interface   = {
-+               .add    = ucb1x00_battery_add,
-+               .remove = ucb1x00_battery_remove,
-+       },
-+};
-+
-+
-+static int __init battery_register(void)
-+{
-+       return ucb1x00_register_interface(&ucb1x00_battery_interface);
-+}
-+
-+static void __exit battery_unregister(void)
-+{
-+       ucb1x00_unregister_interface(&ucb1x00_battery_interface);
-+}
-+
-+module_init(battery_register);
-+module_exit(battery_unregister);
-+
-+MODULE_AUTHOR("Holger Hans Peter Freyther");
-+MODULE_LICENSE("GPL");
-Index: linux-2.6.22/arch/arm/Kconfig
-===================================================================
---- linux-2.6.22.orig/arch/arm/Kconfig  2007-08-23 12:17:42.000000000 +0200
-+++ linux-2.6.22/arch/arm/Kconfig       2007-08-23 12:22:28.000000000 +0200
-@@ -1016,6 +1016,8 @@
- 
- source "drivers/w1/Kconfig"
- 
-+source "drivers/power/Kconfig"
-+
- source "drivers/hwmon/Kconfig"
- 
- #source "drivers/l3/Kconfig"
-Index: linux-2.6.22/drivers/Kconfig
-===================================================================
---- linux-2.6.22.orig/drivers/Kconfig   2007-08-23 12:21:27.000000000 +0200
-+++ linux-2.6.22/drivers/Kconfig        2007-08-23 12:22:03.000000000 +0200
-@@ -54,6 +54,8 @@
- 
- source "drivers/w1/Kconfig"
- 
-+source "drivers/power/Kconfig"
-+
- source "drivers/hwmon/Kconfig"
- 
- source "drivers/mfd/Kconfig"
-Index: linux-2.6.22/drivers/Makefile
-===================================================================
---- linux-2.6.22.orig/drivers/Makefile  2007-08-23 12:33:58.000000000 +0200
-+++ linux-2.6.22/drivers/Makefile       2007-08-23 12:34:34.000000000 +0200
-@@ -61,6 +61,7 @@
- obj-$(CONFIG_RTC_LIB)          += rtc/
- obj-y                          += i2c/
- obj-$(CONFIG_W1)               += w1/
-+obj-$(CONFIG_POWER_SUPPLY)     += power/
- obj-$(CONFIG_HWMON)            += hwmon/
- obj-$(CONFIG_PHONE)            += telephony/
- obj-$(CONFIG_MD)               += md/
-Index: linux-2.6.22/include/linux/power_supply.h
-===================================================================
---- /dev/null   1970-01-01 00:00:00.000000000 +0000
-+++ linux-2.6.22/include/linux/power_supply.h   2007-08-23 12:37:10.000000000 +0200
-@@ -0,0 +1,175 @@
-+/*
-+ *  Universal power supply monitor class
-+ *
-+ *  Copyright (c) 2007  Anton Vorontsov <cbou@mail.ru>
-+ *  Copyright (c) 2004  Szabolcs Gyurko
-+ *  Copyright (c) 2003  Ian Molton <spyro@f2s.com>
-+ *
-+ *  Modified: 2004, Oct     Szabolcs Gyurko
-+ *
-+ *  You may use this code as per GPL version 2
-+ */
-+
-+#ifndef __LINUX_POWER_SUPPLY_H__
-+#define __LINUX_POWER_SUPPLY_H__
-+
-+#include <linux/device.h>
-+#include <linux/workqueue.h>
-+#include <linux/leds.h>
-+
-+/*
-+ * All voltages, currents, charges, energies, time and temperatures in uV,
-+ * uA, uAh, uWh, seconds and tenths of degree Celsius unless otherwise
-+ * stated. It's driver's job to convert its raw values to units in which
-+ * this class operates.
-+ */
-+
-+/*
-+ * For systems where the charger determines the maximum battery capacity
-+ * the min and max fields should be used to present these values to user
-+ * space. Unused/unknown fields will not appear in sysfs.
-+ */
-+
-+enum {
-+       POWER_SUPPLY_STATUS_UNKNOWN = 0,
-+       POWER_SUPPLY_STATUS_CHARGING,
-+       POWER_SUPPLY_STATUS_DISCHARGING,
-+       POWER_SUPPLY_STATUS_NOT_CHARGING,
-+       POWER_SUPPLY_STATUS_FULL,
-+};
-+
-+enum {
-+       POWER_SUPPLY_HEALTH_UNKNOWN = 0,
-+       POWER_SUPPLY_HEALTH_GOOD,
-+       POWER_SUPPLY_HEALTH_OVERHEAT,
-+       POWER_SUPPLY_HEALTH_DEAD,
-+};
-+
-+enum {
-+       POWER_SUPPLY_TECHNOLOGY_UNKNOWN = 0,
-+       POWER_SUPPLY_TECHNOLOGY_NIMH,
-+       POWER_SUPPLY_TECHNOLOGY_LION,
-+       POWER_SUPPLY_TECHNOLOGY_LIPO,
-+};
-+
-+enum {
-+       POWER_SUPPLY_CAPACITY_LEVEL_UNKNOWN = 0,
-+       POWER_SUPPLY_CAPACITY_LEVEL_CRITICAL,
-+       POWER_SUPPLY_CAPACITY_LEVEL_LOW,
-+       POWER_SUPPLY_CAPACITY_LEVEL_NORMAL,
-+       POWER_SUPPLY_CAPACITY_LEVEL_HIGH,
-+       POWER_SUPPLY_CAPACITY_LEVEL_FULL,
-+};
-+
-+enum power_supply_property {
-+       /* Properties of type `int' */
-+       POWER_SUPPLY_PROP_STATUS = 0,
-+       POWER_SUPPLY_PROP_HEALTH,
-+       POWER_SUPPLY_PROP_PRESENT,
-+       POWER_SUPPLY_PROP_ONLINE,
-+       POWER_SUPPLY_PROP_TECHNOLOGY,
-+       POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN,
-+       POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN,
-+       POWER_SUPPLY_PROP_VOLTAGE_NOW,
-+       POWER_SUPPLY_PROP_VOLTAGE_AVG,
-+       POWER_SUPPLY_PROP_CURRENT_NOW,
-+       POWER_SUPPLY_PROP_CURRENT_AVG,
-+       POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN,
-+       POWER_SUPPLY_PROP_CHARGE_EMPTY_DESIGN,
-+       POWER_SUPPLY_PROP_CHARGE_FULL,
-+       POWER_SUPPLY_PROP_CHARGE_EMPTY,
-+       POWER_SUPPLY_PROP_CHARGE_NOW,
-+       POWER_SUPPLY_PROP_CHARGE_AVG,
-+       POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN,
-+       POWER_SUPPLY_PROP_ENERGY_EMPTY_DESIGN,
-+       POWER_SUPPLY_PROP_ENERGY_FULL,
-+       POWER_SUPPLY_PROP_ENERGY_EMPTY,
-+       POWER_SUPPLY_PROP_ENERGY_NOW,
-+       POWER_SUPPLY_PROP_ENERGY_AVG,
-+       POWER_SUPPLY_PROP_CAPACITY, /* in percents! */
-+       POWER_SUPPLY_PROP_CAPACITY_LEVEL,
-+       POWER_SUPPLY_PROP_TEMP,
-+       POWER_SUPPLY_PROP_TEMP_AMBIENT,
-+       POWER_SUPPLY_PROP_TIME_TO_EMPTY_NOW,
-+       POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG,
-+       POWER_SUPPLY_PROP_TIME_TO_FULL_NOW,
-+       POWER_SUPPLY_PROP_TIME_TO_FULL_AVG,
-+       /* Properties of type `const char *' */
-+       POWER_SUPPLY_PROP_MODEL_NAME,
-+};
-+
-+enum power_supply_type {
-+       POWER_SUPPLY_TYPE_BATTERY = 0,
-+       POWER_SUPPLY_TYPE_UPS,
-+       POWER_SUPPLY_TYPE_MAINS,
-+       POWER_SUPPLY_TYPE_USB,
-+};
-+
-+union power_supply_propval {
-+       int intval;
-+       const char *strval;
-+};
-+
-+struct power_supply {
-+       const char *name;
-+       enum power_supply_type type;
-+       enum power_supply_property *properties;
-+       size_t num_properties;
-+
-+       char **supplied_to;
-+       size_t num_supplicants;
-+
-+       int (*get_property)(struct power_supply *psy,
-+                           enum power_supply_property psp,
-+                           union power_supply_propval *val);
-+       void (*external_power_changed)(struct power_supply *psy);
-+
-+       /* For APM emulation, think legacy userspace. */
-+       int use_for_apm;
-+
-+       /* private */
-+       struct device *dev;
-+       struct work_struct changed_work;
-+
-+#ifdef CONFIG_LEDS_TRIGGERS
-+       struct led_trigger *charging_full_trig;
-+       char *charging_full_trig_name;
-+       struct led_trigger *charging_trig;
-+       char *charging_trig_name;
-+       struct led_trigger *full_trig;
-+       char *full_trig_name;
-+       struct led_trigger *online_trig;
-+       char *online_trig_name;
-+#endif
-+};
-+
-+/*
-+ * This is recommended structure to specify static power supply parameters.
-+ * Generic one, parametrizable for different power supplies. Power supply
-+ * class itself does not use it, but that's what implementing most platform
-+ * drivers, should try reuse for consistency.
-+ */
-+
-+struct power_supply_info {
-+       const char *name;
-+       int technology;
-+       int voltage_max_design;
-+       int voltage_min_design;
-+       int charge_full_design;
-+       int charge_empty_design;
-+       int energy_full_design;
-+       int energy_empty_design;
-+       int use_for_apm;
-+};
-+
-+extern void power_supply_changed(struct power_supply *psy);
-+extern int power_supply_am_i_supplied(struct power_supply *psy);
-+
-+extern int power_supply_register(struct device *parent,
-+                                 struct power_supply *psy);
-+extern void power_supply_unregister(struct power_supply *psy);
-+
-+/* For APM emulation, think legacy userspace. */
-+extern struct class *power_supply_class;
-+
-+#endif /* __LINUX_POWER_SUPPLY_H__ */
diff --git a/meta/packages/linux/linux-rp-2.6.23/versatile-armv6.patch b/meta/packages/linux/linux-rp-2.6.23/versatile-armv6.patch
new file mode 100644
index 0000000000..e2d0060ac3
--- /dev/null
+++ b/meta/packages/linux/linux-rp-2.6.23/versatile-armv6.patch
@@ -0,0 +1,19 @@
+---
+ arch/arm/mm/Kconfig |    2 +-
+ 1 file changed, 1 insertion(+), 1 deletion(-)
+
+--- linux-2.6.23.orig/arch/arm/mm/Kconfig
++++ linux-2.6.23/arch/arm/mm/Kconfig
+@@ -343,11 +343,11 @@ config CPU_XSC3
+        select IO_36
+ 
+ # ARMv6
+ config CPU_V6
+        bool "Support ARM V6 processor"
+-       depends on ARCH_INTEGRATOR || MACH_REALVIEW_EB || ARCH_OMAP2 || ARCH_MX3
++       depends on ARCH_INTEGRATOR || MACH_REALVIEW_EB || ARCH_OMAP2 || ARCH_MX3 || ARCH_VERSATILE_PB
+        default y if ARCH_MX3
+        select CPU_32v6
+        select CPU_ABRT_EV6
+        select CPU_CACHE_V6
+        select CPU_CACHE_VIPT
diff --git a/meta/packages/linux/linux-rp-2.6.23/vt_ioctl_race.patch b/meta/packages/linux/linux-rp-2.6.23/vt_ioctl_race.patch
deleted file mode 100644
index 5a51d1c3f5..0000000000
--- a/meta/packages/linux/linux-rp-2.6.23/vt_ioctl_race.patch
+++ /dev/null
@@ -1,46 +0,0 @@
----
- drivers/char/vt_ioctl.c |    8 +++++---
- 1 file changed, 5 insertions(+), 3 deletions(-)
-
-Index: linux-2.6.22/drivers/char/vt_ioctl.c
-===================================================================
---- linux-2.6.22.orig/drivers/char/vt_ioctl.c   2007-07-09 01:32:17.000000000 +0200
-+++ linux-2.6.22/drivers/char/vt_ioctl.c        2007-09-27 11:58:42.000000000 +0200
-@@ -770,6 +770,7 @@
-                /*
-                 * Switching-from response
-                 */
-+               acquire_console_sem();
-                if (vc->vt_newvt >= 0) {
-                        if (arg == 0)
-                                /*
-@@ -784,7 +785,6 @@
-                                 * complete the switch.
-                                 */
-                                int newvt;
--                               acquire_console_sem();
-                                newvt = vc->vt_newvt;
-                                vc->vt_newvt = -1;
-                                i = vc_allocate(newvt);
-@@ -798,7 +798,6 @@
-                                 * other console switches..
-                                 */
-                                complete_change_console(vc_cons[newvt].d);
--                               release_console_sem();
-                        }
-                }
- 
-@@ -810,9 +809,12 @@
-                        /*
-                         * If it's just an ACK, ignore it
-                         */
--                       if (arg != VT_ACKACQ)
-+                       if (arg != VT_ACKACQ) {
-+                               release_console_sem();
-                                return -EINVAL;
-+                       }
-                }
-+               release_console_sem();
- 
-                return 0;
- 
diff --git a/meta/packages/linux/linux-rp-2.6.23/w100fb-unused-var.patch b/meta/packages/linux/linux-rp-2.6.23/w100fb-unused-var.patch
deleted file mode 100644
index 8cbbb6bd01..0000000000
--- a/meta/packages/linux/linux-rp-2.6.23/w100fb-unused-var.patch
+++ /dev/null
@@ -1,17 +0,0 @@
-From: Marcin Juszkiewicz <openembedded@haerwu.biz>
-
-drivers/video/w100fb.c: In function ‘w100fb_imageblit’:
-drivers/video/w100fb.c:507: warning: unused variable ‘par’
-
-Signed-off-by: Marcin Juszkiewicz <openembedded@haerwu.biz>
-
---- linux-2.6.23/drivers/video/w100fb.c 2007-10-11 16:52:30.000000000 +0200
-+++ linux-2.6.23/drivers/video/w100fb.c 2007-10-15 12:56:01.000000000 +0200
-@@ -504,7 +504,6 @@ static void w100_hostdata(u32 width, u32
- static void w100fb_imageblit(struct fb_info *info,
-                              const struct fb_image *image)
- {
--       struct w100fb_par *par = info->par;
-        union dp_gui_master_cntl_u gmc;
-        u32 fgcolor, bgcolor;
- 
diff --git a/meta/packages/linux/linux-rp-2.6.23/wm9712-reset-loop-r2.patch b/meta/packages/linux/linux-rp-2.6.23/wm9712-reset-loop-r2.patch
new file mode 100644
index 0000000000..78e81ea83a
--- /dev/null
+++ b/meta/packages/linux/linux-rp-2.6.23/wm9712-reset-loop-r2.patch
@@ -0,0 +1,44 @@
+ sound/soc/codecs/wm9712.c |   28 ++++++++++++++++++----------
+ 1 file changed, 18 insertions(+), 10 deletions(-)
+
+Index: git/sound/soc/codecs/wm9712.c
+===================================================================
+--- git.orig/sound/soc/codecs/wm9712.c  2006-11-07 22:10:01.000000000 +0000
++++ git/sound/soc/codecs/wm9712.c       2006-11-07 22:11:50.000000000 +0000
+@@ -618,18 +618,26 @@ static int wm9712_dapm_event(struct snd_
+ 
+ static int wm9712_reset(struct snd_soc_codec *codec, int try_warm)
+ {
+-       if (try_warm && soc_ac97_ops.warm_reset) {
+-               soc_ac97_ops.warm_reset(codec->ac97);
+-               if (!(ac97_read(codec, 0) & 0x8000))
+-                       return 1;
+-       }
++       int retry = 3;
+ 
+-       soc_ac97_ops.reset(codec->ac97);
+-       if (ac97_read(codec, 0) & 0x8000)
+-               goto err;
+-       return 0;
++       while (retry--)
++       {
++               if(try_warm && soc_ac97_ops.warm_reset) {
++                       soc_ac97_ops.warm_reset(codec->ac97);
++                       if(ac97_read(codec, 0) & 0x8000)
++                               continue;
++                       else
++                               return 1;
++               }
++
++               soc_ac97_ops.reset(codec->ac97);
++               if(ac97_read(codec, 0) & 0x8000)
++                       continue;
++               else
++                       return 0;
++
++       }
+ 
+-err:
+        printk(KERN_ERR "WM9712 AC97 reset failed\n");
+        return -EIO;
+ }
diff --git a/meta/packages/linux/linux-rp-2.6.23/wm9712-suspend-cold-res-r2.patch b/meta/packages/linux/linux-rp-2.6.23/wm9712-suspend-cold-res-r2.patch
new file mode 100644
index 0000000000..5179b47cc4
--- /dev/null
+++ b/meta/packages/linux/linux-rp-2.6.23/wm9712-suspend-cold-res-r2.patch
@@ -0,0 +1,16 @@
+ sound/soc/codecs/wm9712.c |    2 +-
+ 1 file changed, 1 insertion(+), 1 deletion(-)
+
+Index: git/sound/soc/codecs/wm9712.c
+===================================================================
+--- git.orig/sound/soc/codecs/wm9712.c  2006-11-07 21:57:34.000000000 +0000
++++ git/sound/soc/codecs/wm9712.c       2006-11-07 21:59:30.000000000 +0000
+@@ -651,7 +651,7 @@ static int wm9712_soc_resume(struct plat
+        int i, ret;
+        u16 *cache = codec->reg_cache;
+ 
+-       ret = wm9712_reset(codec, 1);
++       ret = wm9712_reset(codec, 0);
+        if (ret < 0){
+                printk(KERN_ERR "could not reset AC97 codec\n");
+                return ret;
diff --git a/meta/packages/linux/linux-rp-2.6.23/wm97xx-lg13-r0-fix-r0.patch b/meta/packages/linux/linux-rp-2.6.23/wm97xx-lg13-r0-fix-r0.patch
new file mode 100644
index 0000000000..5ad0d8703d
--- /dev/null
+++ b/meta/packages/linux/linux-rp-2.6.23/wm97xx-lg13-r0-fix-r0.patch
@@ -0,0 +1,128 @@
+ drivers/input/power.c                   |    2 +-
+ drivers/input/touchscreen/Kconfig       |    2 +-
+ drivers/input/touchscreen/wm97xx-core.c |   35 ++++++++++++++++---------------
+ include/linux/wm97xx.h                  |    2 +-
+ 4 files changed, 21 insertions(+), 20 deletions(-)
+
+diff --git a/drivers/input/power.c b/drivers/input/power.c
+index 4443e34..7aac875 100644
+--- a/drivers/input/power.c
++++ b/drivers/input/power.c
+@@ -156,7 +156,7 @@ static void power_event(struct input_handle *handle, unsigned int type,
+        }
+ }
+ 
+-static struct input_handle *power_connect(struct input_handler *handler,
++static int power_connect(struct input_handler *handler,
+                                          struct input_dev *dev,
+                                          const struct input_device_id *id)
+ {
+diff --git a/drivers/input/touchscreen/Kconfig b/drivers/input/touchscreen/Kconfig
+index 6862e8f..9b532e9 100644
+--- a/drivers/input/touchscreen/Kconfig
++++ b/drivers/input/touchscreen/Kconfig
+@@ -247,7 +247,7 @@ config TOUCHSCREEN_TSC2101
+ 
+ config TOUCHSCREEN_WM97XX
+        tristate "Support for WM97xx AC97 touchscreen controllers"
+-       depends SND_AC97_BUS
++       depends AC97_BUS
+ 
+ choice
+        prompt "WM97xx codec type"
+diff --git a/drivers/input/touchscreen/wm97xx-core.c b/drivers/input/touchscreen/wm97xx-core.c
+index 9b2710e..d3ce3f3 100644
+--- a/drivers/input/touchscreen/wm97xx-core.c
++++ b/drivers/input/touchscreen/wm97xx-core.c
+@@ -84,6 +84,7 @@
+ #include <linux/bitops.h>
+ #include <linux/workqueue.h>
+ #include <linux/device.h>
++#include <linux/freezer.h>
+ #include <linux/wm97xx.h>
+ #include <asm/uaccess.h>
+ #include <asm/io.h>
+@@ -241,14 +242,15 @@ WM97XX_STATUS_ATTR(gpio);
+ 
+ static int wm97xx_sys_add(struct device *dev)
+ {
++       int err;
+        if (aux_sys) {
+-               device_create_file(dev, &dev_attr_aux1);
+-               device_create_file(dev, &dev_attr_aux2);
+-               device_create_file(dev, &dev_attr_aux3);
+-               device_create_file(dev, &dev_attr_aux4);
++               err = device_create_file(dev, &dev_attr_aux1);    
++               err = device_create_file(dev, &dev_attr_aux2);
++               err = device_create_file(dev, &dev_attr_aux3);
++               err = device_create_file(dev, &dev_attr_aux4);
+        }
+        if (status_sys)
+-               device_create_file(dev, &dev_attr_gpio);
++               err = device_create_file(dev, &dev_attr_gpio);
+        return 0;
+ }
+ 
+@@ -366,12 +368,12 @@ void wm97xx_config_gpio(struct wm97xx *wm, u32 gpio, wm97xx_gpio_dir_t dir,
+ 
+ /*
+  * Handle a pen down interrupt.
+- */
+-static void wm97xx_pen_irq_worker(void *ptr)
+-{
+-       struct wm97xx *wm = (struct wm97xx *) ptr;
+-
+-       /* do we need to enable the touch panel reader */
++ */ 
++static void wm97xx_pen_irq_worker(struct work_struct *work) 
++{                   
++       struct wm97xx *wm = container_of(work, struct wm97xx, pen_event_work);
++       
++       /* do we need to enable the touch panel reader */ 
+        if (wm->id == WM9705_ID2) {
+                if (wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER_RD) & WM97XX_PEN_DOWN)
+                        wm->pen_is_down = 1;
+@@ -411,9 +413,8 @@ static void wm97xx_pen_irq_worker(void *ptr)
+  * We have to disable the codec interrupt in the handler because it can
+  * take upto 1ms to clear the interrupt source. The interrupt is then enabled
+  * again in the slow handler when the source has been cleared.
+- */
+-static irqreturn_t wm97xx_pen_interrupt(int irq, void *dev_id,
+-                                       struct pt_regs *regs)
++ */ 
++static irqreturn_t wm97xx_pen_interrupt(int irq, void *dev_id)
+ {
+        struct wm97xx *wm = (struct wm97xx *) dev_id;
+        disable_irq(wm->pen_irq);
+@@ -428,15 +429,15 @@ static int wm97xx_init_pen_irq(struct wm97xx *wm)
+ {
+        u16 reg;
+ 
+-       INIT_WORK(&wm->pen_event_work, wm97xx_pen_irq_worker, wm);
+-       if ((wm->pen_irq_workq =
++       INIT_WORK(&wm->pen_event_work, wm97xx_pen_irq_worker);
++       if ((wm->pen_irq_workq = 
+                create_singlethread_workqueue("kwm97pen")) == NULL) {
+                err("could not create pen irq work queue");
+                wm->pen_irq = 0;
+                return -EINVAL;
+        }
+ 
+-       if (request_irq (wm->pen_irq, wm97xx_pen_interrupt, SA_SHIRQ, "wm97xx-pen", wm)) {
++       if (request_irq (wm->pen_irq, wm97xx_pen_interrupt, IRQF_SHARED, "wm97xx-pen", wm)) {
+                err("could not register codec pen down interrupt, will poll for pen down");
+                destroy_workqueue(wm->pen_irq_workq);
+                wm->pen_irq = 0;
+diff --git a/include/linux/wm97xx.h b/include/linux/wm97xx.h
+index b1c1740..a9bd57e 100644
+--- a/include/linux/wm97xx.h
++++ b/include/linux/wm97xx.h
+@@ -243,7 +243,7 @@ struct wm97xx {
+        u16 dig_save[3];                /* saved during aux reading */
+        struct wm97xx_codec_drv *codec; /* attached codec driver*/
+        struct input_dev* input_dev;    /* touchscreen input device */
+-       ac97_t *ac97;                   /* ALSA codec access */
++       struct snd_ac97 *ac97;                  /* ALSA codec access */
+        struct device *dev;             /* ALSA device */
+     struct device *battery_dev;
+     struct device *touch_dev;
diff --git a/meta/packages/linux/linux-rp-2.6.23/wm97xx-lg13-r0.patch b/meta/packages/linux/linux-rp-2.6.23/wm97xx-lg13-r0.patch
new file mode 100644
index 0000000000..c918c5daff
--- /dev/null
+++ b/meta/packages/linux/linux-rp-2.6.23/wm97xx-lg13-r0.patch
@@ -0,0 +1,2899 @@
+Index: linux-2.6.17/drivers/input/touchscreen/Kconfig
+===================================================================
+--- linux-2.6.17.orig/drivers/input/touchscreen/Kconfig 2006-09-19 20:35:35.060495500 +0200
++++ linux-2.6.17/drivers/input/touchscreen/Kconfig      2006-09-19 20:36:47.965051750 +0200
+@@ -121,4 +121,57 @@ config TOUCHSCREEN_TSC2101
+          To compile this driver as a module, choose M here: the
+          module will be called ads7846_ts.
+ 
++config TOUCHSCREEN_WM97XX
++       tristate "Support for WM97xx AC97 touchscreen controllers"
++       depends SND_AC97_BUS
++
++choice
++       prompt "WM97xx codec type"
++
++config TOUCHSCREEN_WM9705
++       bool "WM9705 Touchscreen interface support"
++       depends on TOUCHSCREEN_WM97XX
++       help
++         Say Y here if you have the wm9705 touchscreen.
++
++         If unsure, say N.
++
++         To compile this driver as a module, choose M here: the
++         module will be called wm9705.
++
++config TOUCHSCREEN_WM9712
++       bool "WM9712 Touchscreen interface support"
++       depends on TOUCHSCREEN_WM97XX
++       help
++         Say Y here if you have the wm9712 touchscreen.
++
++         If unsure, say N.
++
++         To compile this driver as a module, choose M here: the
++         module will be called wm9712.
++
++config TOUCHSCREEN_WM9713
++       bool "WM9713 Touchscreen interface support"
++       depends on TOUCHSCREEN_WM97XX
++       help
++         Say Y here if you have the wm9713 touchscreen.
++
++         If unsure, say N.
++
++         To compile this driver as a module, choose M here: the
++         module will be called wm9713.
++
++endchoice
++
++config TOUCHSCREEN_WM97XX_PXA
++       tristate "WM97xx PXA accelerated touch"
++       depends on TOUCHSCREEN_WM97XX && ARCH_PXA
++       help
++         Say Y here for continuous mode touch on the PXA
++
++         If unsure, say N
++
++         To compile this driver as a module, choose M here: the
++         module will be called pxa-wm97xx
++
+ endif
+Index: linux-2.6.17/drivers/input/touchscreen/Makefile
+===================================================================
+--- linux-2.6.17.orig/drivers/input/touchscreen/Makefile        2006-09-19 20:35:35.072496250 +0200
++++ linux-2.6.17/drivers/input/touchscreen/Makefile     2006-09-19 20:37:40.540337500 +0200
+@@ -4,6 +4,8 @@
+ 
+ # Each configuration option enables a list of files.
+ 
++wm97xx-ts-objs := wm97xx-core.o
++
+ obj-$(CONFIG_TOUCHSCREEN_ADS7846)      += ads7846.o
+ obj-$(CONFIG_TOUCHSCREEN_BITSY)        += h3600_ts_input.o
+ obj-$(CONFIG_TOUCHSCREEN_CORGI)        += corgi_ts.o
+@@ -13,3 +15,16 @@ obj-$(CONFIG_TOUCHSCREEN_MTOUCH) += mtou
+ obj-$(CONFIG_TOUCHSCREEN_MK712)        += mk712.o
+ obj-$(CONFIG_TOUCHSCREEN_HP600)        += hp680_ts_input.o
+ obj-$(CONFIG_TOUCHSCREEN_TSC2101)      += tsc2101_ts.o
++obj-$(CONFIG_TOUCHSCREEN_WM97XX)       += wm97xx-ts.o
++obj-$(CONFIG_TOUCHSCREEN_WM97XX_PXA)    += pxa-wm97xx.o
++
++ifeq ($(CONFIG_TOUCHSCREEN_WM9713),y)
++wm97xx-ts-objs += wm9713.o
++endif
++
++ifeq ($(CONFIG_TOUCHSCREEN_WM9712),y)
++wm97xx-ts-objs += wm9712.o
++endif
++ifeq ($(CONFIG_TOUCHSCREEN_WM9705),y)
++wm97xx-ts-objs += wm9705.o
++endif
+Index: linux-2.6.17/drivers/input/touchscreen/pxa-wm97xx.c
+===================================================================
+--- /dev/null   1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.17/drivers/input/touchscreen/pxa-wm97xx.c 2006-09-19 20:36:47.965051750 +0200
+@@ -0,0 +1,289 @@
++/*
++ * pxa-wm97xx.c  --  pxa-wm97xx Continuous Touch screen driver for
++ *                   Wolfson WM97xx AC97 Codecs.
++ *
++ * Copyright 2004 Wolfson Microelectronics PLC.
++ * Author: Liam Girdwood
++ *         liam.girdwood@wolfsonmicro.com or linux@wolfsonmicro.com
++ * Parts Copyright : Ian Molton <spyro@f2s.com>
++ *                   Andrew Zabolotny <zap@homelink.ru>
++ *
++ *  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.
++ *
++ * Notes:
++ *     This is a wm97xx extended touch driver to capture touch
++ *     data in a continuous manner on the Intel XScale archictecture
++ *
++ *  Features:
++ *       - codecs supported:- WM9705, WM9712, WM9713
++ *       - processors supported:- Intel XScale PXA25x, PXA26x, PXA27x
++ *
++ *  Revision history
++ *    18th Aug 2004   Initial version.
++ *    26th Jul 2005   Improved continous read back and added FIFO flushing.
++ *    06th Sep 2005   Mike Arthur <linux@wolfsonmicro.com>
++ *                    Moved to using the wm97xx bus
++ *
++ */
++
++#include <linux/module.h>
++#include <linux/moduleparam.h>
++#include <linux/version.h>
++#include <linux/kernel.h>
++#include <linux/init.h>
++#include <linux/delay.h>
++#include <linux/irq.h>
++#include <linux/wm97xx.h>
++#include <asm/io.h>
++#include <asm/arch/pxa-regs.h>
++
++#define VERSION                "0.13"
++
++struct continuous {
++       u16 id;    /* codec id */
++       u8 code;   /* continuous code */
++       u8 reads;  /* number of coord reads per read cycle */
++       u32 speed; /* number of coords per second */
++};
++
++#define WM_READS(sp) ((sp / HZ) + 1)
++
++static const struct continuous cinfo[] = {
++       {WM9705_ID2, 0, WM_READS(94), 94},
++       {WM9705_ID2, 1, WM_READS(188), 188},
++       {WM9705_ID2, 2, WM_READS(375), 375},
++       {WM9705_ID2, 3, WM_READS(750), 750},
++       {WM9712_ID2, 0, WM_READS(94), 94},
++       {WM9712_ID2, 1, WM_READS(188), 188},
++       {WM9712_ID2, 2, WM_READS(375), 375},
++       {WM9712_ID2, 3, WM_READS(750), 750},
++       {WM9713_ID2, 0, WM_READS(94), 94},
++       {WM9713_ID2, 1, WM_READS(120), 120},
++       {WM9713_ID2, 2, WM_READS(154), 154},
++       {WM9713_ID2, 3, WM_READS(188), 188},
++};
++
++/* continuous speed index */
++static int sp_idx = 0;
++static u16 last = 0, tries = 0;
++
++/*
++ * Pen sampling frequency (Hz) in continuous mode.
++ */
++static int cont_rate = 200;
++module_param(cont_rate, int, 0);
++MODULE_PARM_DESC(cont_rate, "Sampling rate in continuous mode (Hz)");
++
++/*
++ * Pen down detection.
++ *
++ * This driver can either poll or use an interrupt to indicate a pen down
++ * event. If the irq request fails then it will fall back to polling mode.
++ */
++static int pen_int = 1;
++module_param(pen_int, int, 0);
++MODULE_PARM_DESC(pen_int, "Pen down detection (1 = interrupt, 0 = polling)");
++
++/*
++ * Pressure readback.
++ *
++ * Set to 1 to read back pen down pressure
++ */
++static int pressure = 0;
++module_param(pressure, int, 0);
++MODULE_PARM_DESC(pressure, "Pressure readback (1 = pressure, 0 = no pressure)");
++
++/*
++ * AC97 touch data slot.
++ *
++ * Touch screen readback data ac97 slot
++ */
++static int ac97_touch_slot = 5;
++module_param(ac97_touch_slot, int, 0);
++MODULE_PARM_DESC(ac97_touch_slot, "Touch screen data slot AC97 number");
++
++
++/* flush AC97 slot 5 FIFO on pxa machines */
++#ifdef CONFIG_PXA27x
++void wm97xx_acc_pen_up (struct wm97xx* wm)
++{
++       set_current_state(TASK_INTERRUPTIBLE);
++       schedule_timeout(1);
++
++       while (MISR & (1 << 2))
++               MODR;
++}
++#else
++void wm97xx_acc_pen_up (struct wm97xx* wm)
++{
++       int count = 16;
++       set_current_state(TASK_INTERRUPTIBLE);
++       schedule_timeout(1);
++
++       while (count < 16) {
++               MODR;
++               count--;
++       }
++}
++#endif
++
++int wm97xx_acc_pen_down (struct wm97xx* wm)
++{
++       u16 x, y, p = 0x100 | WM97XX_ADCSEL_PRES;
++       int reads = 0;
++
++       /* data is never immediately available after pen down irq */
++       set_current_state(TASK_INTERRUPTIBLE);
++       schedule_timeout(1);
++
++       if (tries > 5){
++               tries = 0;
++               return RC_PENUP;
++       }
++
++       x = MODR;
++       if (x == last) {
++               tries++;
++               return RC_AGAIN;
++       }
++       last = x;
++       do {
++               if (reads)
++                       x= MODR;
++               y= MODR;
++               if (pressure)
++                       p = MODR;
++
++               /* are samples valid */
++               if ((x & 0x7000) != WM97XX_ADCSEL_X ||
++                       (y & 0x7000) != WM97XX_ADCSEL_Y ||
++                       (p & 0x7000) != WM97XX_ADCSEL_PRES)
++                       goto up;
++
++               /* coordinate is good */
++               tries = 0;
++               //printk("x %x y %x p %x\n", x,y,p);
++               input_report_abs (wm->input_dev, ABS_X, x & 0xfff);
++               input_report_abs (wm->input_dev, ABS_Y, y & 0xfff);
++               input_report_abs (wm->input_dev, ABS_PRESSURE, p & 0xfff);
++               input_sync (wm->input_dev);
++               reads++;
++       } while (reads < cinfo[sp_idx].reads);
++up:
++       return RC_PENDOWN | RC_AGAIN;
++}
++
++int wm97xx_acc_startup(struct wm97xx* wm)
++{
++       int idx = 0;
++
++       /* check we have a codec */
++       if (wm->ac97 == NULL)
++               return -ENODEV;
++
++       /* Go you big red fire engine */
++       for (idx = 0; idx < ARRAY_SIZE(cinfo); idx++) {
++               if (wm->id != cinfo[idx].id)
++                       continue;
++               sp_idx = idx;
++               if (cont_rate <= cinfo[idx].speed)
++                       break;
++       }
++       wm->acc_rate = cinfo[sp_idx].code;
++       wm->acc_slot = ac97_touch_slot;
++       printk(KERN_INFO "pxa2xx accelerated touchscreen driver, %d samples (sec)\n",
++               cinfo[sp_idx].speed);
++
++       /* codec specific irq config */
++       if (pen_int) {
++               switch (wm->id) {
++                       case WM9705_ID2:
++                               wm->pen_irq = IRQ_GPIO(4);
++                               set_irq_type(IRQ_GPIO(4), IRQT_BOTHEDGE);
++                               break;
++                       case WM9712_ID2:
++                       case WM9713_ID2:
++                               /* enable pen down interrupt */
++                               /* use PEN_DOWN GPIO 13 to assert IRQ on GPIO line 2 */
++                               wm->pen_irq = MAINSTONE_AC97_IRQ;
++                               wm97xx_config_gpio(wm, WM97XX_GPIO_13, WM97XX_GPIO_IN,
++                                       WM97XX_GPIO_POL_HIGH, WM97XX_GPIO_STICKY, WM97XX_GPIO_WAKE);
++                               wm97xx_config_gpio(wm, WM97XX_GPIO_2, WM97XX_GPIO_OUT,
++                                       WM97XX_GPIO_POL_HIGH, WM97XX_GPIO_NOTSTICKY, WM97XX_GPIO_NOWAKE);
++                               break;
++                       default:
++                               printk(KERN_WARNING "pen down irq not supported on this device\n");
++                               pen_int = 0;
++                               break;
++               }
++       }
++
++       return 0;
++}
++
++void wm97xx_acc_shutdown(struct wm97xx* wm)
++{
++    /* codec specific deconfig */
++       if (pen_int) {
++               switch (wm->id & 0xffff) {
++                       case WM9705_ID2:
++                               wm->pen_irq = 0;
++                               break;
++                       case WM9712_ID2:
++                       case WM9713_ID2:
++                               /* disable interrupt */
++                               wm->pen_irq = 0;
++                               break;
++               }
++       }
++}
++
++static struct wm97xx_mach_ops pxa_mach_ops = {
++       .acc_enabled = 1,
++       .acc_pen_up = wm97xx_acc_pen_up,
++    .acc_pen_down = wm97xx_acc_pen_down,
++    .acc_startup = wm97xx_acc_startup,
++    .acc_shutdown = wm97xx_acc_shutdown,
++};
++
++int pxa_wm97xx_probe(struct device *dev)
++{
++    struct wm97xx *wm = dev->driver_data;
++    return wm97xx_register_mach_ops (wm, &pxa_mach_ops);
++}
++
++int pxa_wm97xx_remove(struct device *dev)
++{
++       struct wm97xx *wm = dev->driver_data;
++    wm97xx_unregister_mach_ops (wm);
++    return 0;
++}
++
++static struct device_driver  pxa_wm97xx_driver = {
++    .name = "wm97xx-touchscreen",
++    .bus = &wm97xx_bus_type,
++    .owner = THIS_MODULE,
++    .probe = pxa_wm97xx_probe,
++    .remove = pxa_wm97xx_remove
++};
++
++static int __init pxa_wm97xx_init(void)
++{
++    return driver_register(&pxa_wm97xx_driver);
++}
++
++static void __exit pxa_wm97xx_exit(void)
++{
++    driver_unregister(&pxa_wm97xx_driver);
++}
++
++module_init(pxa_wm97xx_init);
++module_exit(pxa_wm97xx_exit);
++
++/* Module information */
++MODULE_AUTHOR("Liam Girdwood <liam.girdwood@wolfsonmicro.com>");
++MODULE_DESCRIPTION("wm97xx continuous touch driver for pxa2xx");
++MODULE_LICENSE("GPL");
+Index: linux-2.6.17/drivers/input/touchscreen/wm9705.c
+===================================================================
+--- /dev/null   1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.17/drivers/input/touchscreen/wm9705.c     2006-09-19 20:36:47.969052000 +0200
+@@ -0,0 +1,360 @@
++/*
++ * wm9705.c  --  Codec driver for Wolfson WM9705 AC97 Codec.
++ *
++ * Copyright 2003, 2004, 2005, 2006 Wolfson Microelectronics PLC.
++ * Author: Liam Girdwood
++ *         liam.girdwood@wolfsonmicro.com or linux@wolfsonmicro.com
++ * Parts Copyright : Ian Molton <spyro@f2s.com>
++ *                   Andrew Zabolotny <zap@homelink.ru>
++ *                   Russell King <rmk@arm.linux.org.uk>
++ *
++ *  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.
++ *
++ *  Revision history
++ *     6th Sep 2006  Mike Arthur <linux@wolfsonmicro.com>
++ *                   Added pre and post sample calls.
++ *
++ */
++
++#include <linux/module.h>
++#include <linux/moduleparam.h>
++#include <linux/version.h>
++#include <linux/kernel.h>
++#include <linux/input.h>
++#include <linux/delay.h>
++#include <linux/bitops.h>
++#include <linux/wm97xx.h>
++
++#define TS_NAME                        "wm97xx"
++#define WM9705_VERSION         "0.62"
++#define DEFAULT_PRESSURE       0xb0c0
++
++/*
++ * Debug
++ */
++#if 0
++#define dbg(format, arg...) printk(KERN_DEBUG TS_NAME ": " format "\n" , ## arg)
++#else
++#define dbg(format, arg...)
++#endif
++#define err(format, arg...) printk(KERN_ERR TS_NAME ": " format "\n" , ## arg)
++#define info(format, arg...) printk(KERN_INFO TS_NAME ": " format "\n" , ## arg)
++#define warn(format, arg...) printk(KERN_WARNING TS_NAME ": " format "\n" , ## arg)
++
++/*
++ * Module parameters
++ */
++
++/*
++ * Set current used for pressure measurement.
++ *
++ * Set pil = 2 to use 400uA
++ *     pil = 1 to use 200uA and
++ *     pil = 0 to disable pressure measurement.
++ *
++ * This is used to increase the range of values returned by the adc
++ * when measureing touchpanel pressure.
++ */
++static int pil = 0;
++module_param(pil, int, 0);
++MODULE_PARM_DESC(pil, "Set current used for pressure measurement.");
++
++/*
++ * Set threshold for pressure measurement.
++ *
++ * Pen down pressure below threshold is ignored.
++ */
++static int pressure = DEFAULT_PRESSURE & 0xfff;
++module_param(pressure, int, 0);
++MODULE_PARM_DESC(pressure, "Set threshold for pressure measurement.");
++
++/*
++ * Set adc sample delay.
++ *
++ * For accurate touchpanel measurements, some settling time may be
++ * required between the switch matrix applying a voltage across the
++ * touchpanel plate and the ADC sampling the signal.
++ *
++ * This delay can be set by setting delay = n, where n is the array
++ * position of the delay in the array delay_table below.
++ * Long delays > 1ms are supported for completeness, but are not
++ * recommended.
++ */
++static int delay = 4;
++module_param(delay, int, 0);
++MODULE_PARM_DESC(delay, "Set adc sample delay.");
++
++/*
++ * Pen detect comparator threshold.
++ *
++ * 0 to Vmid in 15 steps, 0 = use zero power comparator with Vmid threshold
++ * i.e. 1 =  Vmid/15 threshold
++ *      15 =  Vmid/1 threshold
++ *
++ * Adjust this value if you are having problems with pen detect not
++ * detecting any down events.
++ */
++static int pdd = 8;
++module_param(pdd, int, 0);
++MODULE_PARM_DESC(pdd, "Set pen detect comparator threshold");
++
++/*
++ * Set adc mask function.
++ *
++ * Sources of glitch noise, such as signals driving an LCD display, may feed
++ * through to the touch screen plates and affect measurement accuracy. In
++ * order to minimise this, a signal may be applied to the MASK pin to delay or
++ * synchronise the sampling.
++ *
++ * 0 = No delay or sync
++ * 1 = High on pin stops conversions
++ * 2 = Edge triggered, edge on pin delays conversion by delay param (above)
++ * 3 = Edge triggered, edge on pin starts conversion after delay param
++ */
++static int mask = 0;
++module_param(mask, int, 0);
++MODULE_PARM_DESC(mask, "Set adc mask function.");
++
++/*
++ * ADC sample delay times in uS
++ */
++static const int delay_table[] = {
++       21,    // 1 AC97 Link frames
++       42,    // 2
++       84,    // 4
++       167,   // 8
++       333,   // 16
++       667,   // 32
++       1000,  // 48
++       1333,  // 64
++       2000,  // 96
++       2667,  // 128
++       3333,  // 160
++       4000,  // 192
++       4667,  // 224
++       5333,  // 256
++       6000,  // 288
++       0      // No delay, switch matrix always on
++};
++
++/*
++ * Delay after issuing a POLL command.
++ *
++ * The delay is 3 AC97 link frames + the touchpanel settling delay
++ */
++static inline void poll_delay(int d)
++{
++       udelay (3 * AC97_LINK_FRAME + delay_table [d]);
++}
++
++/*
++ * set up the physical settings of the WM9705
++ */
++static void init_wm9705_phy(struct wm97xx* wm)
++{
++       u16 dig1 = 0, dig2 = WM97XX_RPR;
++
++       /*
++       * mute VIDEO and AUX as they share X and Y touchscreen
++       * inputs on the WM9705
++       */
++       wm97xx_reg_write(wm, AC97_AUX, 0x8000);
++       wm97xx_reg_write(wm, AC97_VIDEO, 0x8000);
++
++       /* touchpanel pressure current*/
++       if  (pil == 2) {
++               dig2 |= WM9705_PIL;
++               dbg("setting pressure measurement current to 400uA.");
++       } else if (pil)
++               dbg("setting pressure measurement current to 200uA.");
++       if(!pil)
++               pressure = 0;
++
++       /* polling mode sample settling delay */
++       if (delay!=4) {
++               if (delay < 0 || delay > 15) {
++                   dbg("supplied delay out of range.");
++                   delay = 4;
++               }
++       }
++       dig1 &= 0xff0f;
++       dig1 |= WM97XX_DELAY(delay);
++       dbg("setting adc sample delay to %d u Secs.", delay_table[delay]);
++
++       /* WM9705 pdd */
++       dig2 |= (pdd & 0x000f);
++       dbg("setting pdd to Vmid/%d", 1 - (pdd & 0x000f));
++
++       /* mask */
++       dig2 |= ((mask & 0x3) << 4);
++
++       wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER1, dig1);
++       wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER2, dig2);
++}
++
++static int wm9705_digitiser_ioctl(struct wm97xx* wm, int cmd)
++{
++       switch(cmd) {
++       case WM97XX_DIG_START:
++               wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER2, wm->dig[2] | WM97XX_PRP_DET_DIG);
++               wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER_RD); /* dummy read */
++               break;
++       case WM97XX_DIG_STOP:
++               wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER2, wm->dig[2] & ~WM97XX_PRP_DET_DIG);
++               break;
++       case WM97XX_AUX_PREPARE:
++               memcpy(wm->dig_save, wm->dig, sizeof(wm->dig));
++               wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER1, 0);
++               wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER2, WM97XX_PRP_DET_DIG);
++               break;
++       case WM97XX_DIG_RESTORE:
++               wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER1, wm->dig_save[1]);
++               wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER2, wm->dig_save[2]);
++               break;
++       case WM97XX_PHY_INIT:
++               init_wm9705_phy(wm);
++               break;
++       default:
++               return -EINVAL;
++       }
++       return 0;
++}
++
++static inline int is_pden (struct wm97xx* wm)
++{
++       return wm->dig[2] & WM9705_PDEN;
++}
++
++/*
++ * Read a sample from the WM9705 adc in polling mode.
++ */
++static int wm9705_poll_sample (struct wm97xx* wm, int adcsel, int *sample)
++{
++       int timeout = 5 * delay;
++
++       if (!wm->pen_probably_down) {
++               u16 data = wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER_RD);
++               if (!(data & WM97XX_PEN_DOWN))
++                       return RC_PENUP;
++               wm->pen_probably_down = 1;
++       }
++
++       /* set up digitiser */
++       if (adcsel & 0x8000)
++               adcsel = ((adcsel & 0x7fff) + 3) << 12;
++
++       if (wm->mach_ops && wm->mach_ops->pre_sample)
++               wm->mach_ops->pre_sample(adcsel);
++       wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER1, adcsel | WM97XX_POLL | WM97XX_DELAY(delay));
++
++       /* wait 3 AC97 time slots + delay for conversion */
++       poll_delay (delay);
++
++       /* wait for POLL to go low */
++       while ((wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER1) & WM97XX_POLL) && timeout) {
++               udelay(AC97_LINK_FRAME);
++               timeout--;
++       }
++
++       if (timeout <= 0) {
++               /* If PDEN is set, we can get a timeout when pen goes up */
++               if (is_pden(wm))
++                       wm->pen_probably_down = 0;
++               else
++                       dbg ("adc sample timeout");
++               return RC_PENUP;
++       }
++
++       *sample = wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER_RD);
++       if (wm->mach_ops && wm->mach_ops->post_sample)
++               wm->mach_ops->post_sample(adcsel);
++
++       /* check we have correct sample */
++       if ((*sample & WM97XX_ADCSEL_MASK) != adcsel) {
++               dbg ("adc wrong sample, read %x got %x", adcsel,
++               *sample & WM97XX_ADCSEL_MASK);
++               return RC_PENUP;
++       }
++
++       if (!(*sample & WM97XX_PEN_DOWN)) {
++               wm->pen_probably_down = 0;
++               return RC_PENUP;
++       }
++
++       return RC_VALID;
++}
++
++/*
++ * Sample the WM9705 touchscreen in polling mode
++ */
++static int wm9705_poll_touch(struct wm97xx* wm, struct wm97xx_data *data)
++{
++       int rc;
++
++       if ((rc = wm9705_poll_sample(wm, WM97XX_ADCSEL_X, &data->x)) != RC_VALID)
++               return rc;
++       if ((rc = wm9705_poll_sample(wm, WM97XX_ADCSEL_Y, &data->y)) != RC_VALID)
++               return rc;
++       if (pil) {
++               if ((rc = wm9705_poll_sample(wm, WM97XX_ADCSEL_PRES, &data->p)) != RC_VALID)
++                       return rc;
++       } else
++               data->p = DEFAULT_PRESSURE;
++
++       return RC_VALID;
++}
++
++/*
++ * Enable WM9705 continuous mode, i.e. touch data is streamed across an AC97 slot
++ */
++static int wm9705_acc_enable (struct wm97xx* wm, int enable)
++{
++       u16 dig1, dig2;
++       int ret = 0;
++
++       dig1 = wm->dig[1];
++       dig2 = wm->dig[2];
++
++       if (enable) {
++               /* continous mode */
++               if (wm->mach_ops->acc_startup && (ret = wm->mach_ops->acc_startup(wm)) < 0)
++                       return ret;
++               dig1 &= ~(WM97XX_CM_RATE_MASK | WM97XX_ADCSEL_MASK |
++                       WM97XX_DELAY_MASK | WM97XX_SLT_MASK);
++               dig1 |= WM97XX_CTC | WM97XX_COO | WM97XX_SLEN |
++                       WM97XX_DELAY (delay) |
++                       WM97XX_SLT (wm->acc_slot) |
++                       WM97XX_RATE (wm->acc_rate);
++               if (pil)
++                       dig1 |= WM97XX_ADCSEL_PRES;
++               dig2 |= WM9705_PDEN;
++       } else {
++               dig1 &= ~(WM97XX_CTC | WM97XX_COO | WM97XX_SLEN);
++               dig2 &= ~WM9705_PDEN;
++               if (wm->mach_ops->acc_shutdown)
++                       wm->mach_ops->acc_shutdown(wm);
++       }
++
++       wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER1, dig1);
++       wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER2, dig2);
++       return ret;
++}
++
++struct wm97xx_codec_drv wm97xx_codec = {
++       .id =   WM9705_ID2,
++       .name = "wm9705",
++       .poll_sample = wm9705_poll_sample,
++       .poll_touch = wm9705_poll_touch,
++       .acc_enable = wm9705_acc_enable,
++       .digitiser_ioctl = wm9705_digitiser_ioctl,
++};
++
++EXPORT_SYMBOL_GPL(wm97xx_codec);
++
++/* Module information */
++MODULE_AUTHOR("Liam Girdwood, liam.girdwood@wolfsonmicro.com, www.wolfsonmicro.com");
++MODULE_DESCRIPTION("WM9705 Touch Screen Driver");
++MODULE_LICENSE("GPL");
+Index: linux-2.6.17/drivers/input/touchscreen/wm9712.c
+===================================================================
+--- /dev/null   1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.17/drivers/input/touchscreen/wm9712.c     2006-09-19 20:36:47.969052000 +0200
+@@ -0,0 +1,464 @@
++/*
++ * wm9712.c  --  Codec driver for Wolfson WM9712 AC97 Codecs.
++ *
++ * Copyright 2003, 2004, 2005, 2006 Wolfson Microelectronics PLC.
++ * Author: Liam Girdwood
++ *         liam.girdwood@wolfsonmicro.com or linux@wolfsonmicro.com
++ * Parts Copyright : Ian Molton <spyro@f2s.com>
++ *                   Andrew Zabolotny <zap@homelink.ru>
++ *                   Russell King <rmk@arm.linux.org.uk>
++ *
++ *  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.
++ *
++ *  Revision history
++ *     4th Jul 2005  Initial version.
++ *     6th Sep 2006  Mike Arthur <linux@wolfsonmicro.com>
++ *                   Added pre and post sample calls.
++ *
++ */
++
++#include <linux/module.h>
++#include <linux/moduleparam.h>
++#include <linux/version.h>
++#include <linux/kernel.h>
++#include <linux/input.h>
++#include <linux/delay.h>
++#include <linux/bitops.h>
++#include <linux/wm97xx.h>
++
++#define TS_NAME                        "wm97xx"
++#define WM9712_VERSION         "0.61"
++#define DEFAULT_PRESSURE       0xb0c0
++
++/*
++ * Debug
++ */
++#if 0
++#define dbg(format, arg...) printk(KERN_DEBUG TS_NAME ": " format "\n" , ## arg)
++#else
++#define dbg(format, arg...)
++#endif
++#define err(format, arg...) printk(KERN_ERR TS_NAME ": " format "\n" , ## arg)
++#define info(format, arg...) printk(KERN_INFO TS_NAME ": " format "\n" , ## arg)
++#define warn(format, arg...) printk(KERN_WARNING TS_NAME ": " format "\n" , ## arg)
++
++/*
++ * Module parameters
++ */
++
++/*
++ * Set internal pull up for pen detect.
++ *
++ * Pull up is in the range 1.02k (least sensitive) to 64k (most sensitive)
++ * i.e. pull up resistance = 64k Ohms / rpu.
++ *
++ * Adjust this value if you are having problems with pen detect not
++ * detecting any down event.
++ */
++static int rpu = 3;
++module_param(rpu, int, 0);
++MODULE_PARM_DESC(rpu, "Set internal pull up resitor for pen detect.");
++
++/*
++ * Set current used for pressure measurement.
++ *
++ * Set pil = 2 to use 400uA
++ *     pil = 1 to use 200uA and
++ *     pil = 0 to disable pressure measurement.
++ *
++ * This is used to increase the range of values returned by the adc
++ * when measureing touchpanel pressure.
++ */
++static int pil = 0;
++module_param(pil, int, 0);
++MODULE_PARM_DESC(pil, "Set current used for pressure measurement.");
++
++/*
++ * Set threshold for pressure measurement.
++ *
++ * Pen down pressure below threshold is ignored.
++ */
++static int pressure = DEFAULT_PRESSURE & 0xfff;
++module_param(pressure, int, 0);
++MODULE_PARM_DESC(pressure, "Set threshold for pressure measurement.");
++
++/*
++ * Set adc sample delay.
++ *
++ * For accurate touchpanel measurements, some settling time may be
++ * required between the switch matrix applying a voltage across the
++ * touchpanel plate and the ADC sampling the signal.
++ *
++ * This delay can be set by setting delay = n, where n is the array
++ * position of the delay in the array delay_table below.
++ * Long delays > 1ms are supported for completeness, but are not
++ * recommended.
++ */
++static int delay = 3;
++module_param(delay, int, 0);
++MODULE_PARM_DESC(delay, "Set adc sample delay.");
++
++/*
++ * Set five_wire = 1 to use a 5 wire touchscreen.
++ *
++ * NOTE: Five wire mode does not allow for readback of pressure.
++ */
++static int five_wire;
++module_param(five_wire, int, 0);
++MODULE_PARM_DESC(five_wire, "Set to '1' to use 5-wire touchscreen.");
++
++/*
++ * Set adc mask function.
++ *
++ * Sources of glitch noise, such as signals driving an LCD display, may feed
++ * through to the touch screen plates and affect measurement accuracy. In
++ * order to minimise this, a signal may be applied to the MASK pin to delay or
++ * synchronise the sampling.
++ *
++ * 0 = No delay or sync
++ * 1 = High on pin stops conversions
++ * 2 = Edge triggered, edge on pin delays conversion by delay param (above)
++ * 3 = Edge triggered, edge on pin starts conversion after delay param
++ */
++static int mask = 0;
++module_param(mask, int, 0);
++MODULE_PARM_DESC(mask, "Set adc mask function.");
++
++/*
++ * Coordinate Polling Enable.
++ *
++ * Set to 1 to enable coordinate polling. e.g. x,y[,p] is sampled together
++ * for every poll.
++ */
++static int coord = 0;
++module_param(coord, int, 0);
++MODULE_PARM_DESC(coord, "Polling coordinate mode");
++
++/*
++ * ADC sample delay times in uS
++ */
++static const int delay_table[] = {
++       21,    // 1 AC97 Link frames
++       42,    // 2
++       84,    // 4
++       167,   // 8
++       333,   // 16
++       667,   // 32
++       1000,  // 48
++       1333,  // 64
++       2000,  // 96
++       2667,  // 128
++       3333,  // 160
++       4000,  // 192
++       4667,  // 224
++       5333,  // 256
++       6000,  // 288
++       0      // No delay, switch matrix always on
++};
++
++/*
++ * Delay after issuing a POLL command.
++ *
++ * The delay is 3 AC97 link frames + the touchpanel settling delay
++ */
++static inline void poll_delay(int d)
++{
++       udelay (3 * AC97_LINK_FRAME + delay_table [d]);
++}
++
++/*
++ * set up the physical settings of the WM9712
++ */
++static void init_wm9712_phy(struct wm97xx* wm)
++{
++       u16 dig1 = 0;
++       u16 dig2 = WM97XX_RPR | WM9712_RPU(1);
++
++       /* WM9712 rpu */
++       if (rpu) {
++               dig2 &= 0xffc0;
++               dig2 |= WM9712_RPU(rpu);
++               dbg("setting pen detect pull-up to %d Ohms",64000 / rpu);
++       }
++
++       /* touchpanel pressure current*/
++       if (pil == 2) {
++               dig2 |= WM9712_PIL;
++               dbg("setting pressure measurement current to 400uA.");
++       } else if (pil)
++               dbg("setting pressure measurement current to 200uA.");
++       if(!pil)
++               pressure = 0;
++
++       /* WM9712 five wire */
++       if (five_wire) {
++               dig2 |= WM9712_45W;
++               dbg("setting 5-wire touchscreen mode.");
++       }
++
++       /* polling mode sample settling delay */
++       if (delay < 0 || delay > 15) {
++               dbg("supplied delay out of range.");
++               delay = 4;
++       }
++       dig1 &= 0xff0f;
++       dig1 |= WM97XX_DELAY(delay);
++       dbg("setting adc sample delay to %d u Secs.", delay_table[delay]);
++
++       /* mask */
++       dig2 |= ((mask & 0x3) << 6);
++       if (mask) {
++               u16 reg;
++               /* Set GPIO4 as Mask Pin*/
++               reg = wm97xx_reg_read(wm, AC97_MISC_AFE);
++               wm97xx_reg_write(wm, AC97_MISC_AFE, reg | WM97XX_GPIO_4);
++               reg = wm97xx_reg_read(wm, AC97_GPIO_CFG);
++               wm97xx_reg_write(wm, AC97_GPIO_CFG, reg | WM97XX_GPIO_4);
++       }
++
++       /* wait - coord mode */
++       if(coord)
++               dig2 |= WM9712_WAIT;
++
++       wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER1, dig1);
++       wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER2, dig2);
++}
++
++static int wm9712_digitiser_ioctl(struct wm97xx* wm, int cmd)
++{
++       u16 dig2 = wm->dig[2];
++
++       switch(cmd) {
++       case WM97XX_DIG_START:
++               wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER2, dig2 | WM97XX_PRP_DET_DIG);
++               wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER_RD); /* dummy read */
++               break;
++       case WM97XX_DIG_STOP:
++               wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER2, dig2 & ~WM97XX_PRP_DET_DIG);
++               break;
++       case WM97XX_AUX_PREPARE:
++               memcpy(wm->dig_save, wm->dig, sizeof(wm->dig));
++               wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER1, 0);
++               wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER2, WM97XX_PRP_DET_DIG);
++               break;
++       case WM97XX_DIG_RESTORE:
++               wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER1, wm->dig_save[1]);
++               wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER2, wm->dig_save[2]);
++               break;
++       case WM97XX_PHY_INIT:
++               init_wm9712_phy(wm);
++               break;
++       default:
++               return -EINVAL;
++       }
++       return 0;
++}
++
++static inline int is_pden (struct wm97xx* wm)
++{
++       return wm->dig[2] & WM9712_PDEN;
++}
++
++/*
++ * Read a sample from the WM9712 adc in polling mode.
++ */
++static int wm9712_poll_sample (struct wm97xx* wm, int adcsel, int *sample)
++{
++       int timeout = 5 * delay;
++
++       if (!wm->pen_probably_down) {
++               u16 data = wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER_RD);
++               if (!(data & WM97XX_PEN_DOWN))
++                       return RC_PENUP;
++               wm->pen_probably_down = 1;
++       }
++
++       /* set up digitiser */
++       if (adcsel & 0x8000)
++               adcsel = ((adcsel & 0x7fff) + 3) << 12;
++
++       if (wm->mach_ops && wm->mach_ops->pre_sample)
++               wm->mach_ops->pre_sample(adcsel);
++       wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER1, adcsel | WM97XX_POLL | WM97XX_DELAY(delay));
++
++       /* wait 3 AC97 time slots + delay for conversion */
++       poll_delay (delay);
++
++       /* wait for POLL to go low */
++       while ((wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER1) & WM97XX_POLL) && timeout) {
++               udelay(AC97_LINK_FRAME);
++               timeout--;
++       }
++
++       if (timeout <= 0) {
++               /* If PDEN is set, we can get a timeout when pen goes up */
++               if (is_pden(wm))
++                       wm->pen_probably_down = 0;
++               else
++                       dbg ("adc sample timeout");
++               return RC_PENUP;
++       }
++
++       *sample = wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER_RD);
++       if (wm->mach_ops && wm->mach_ops->post_sample)
++               wm->mach_ops->post_sample(adcsel);
++
++       /* check we have correct sample */
++       if ((*sample & WM97XX_ADCSEL_MASK) != adcsel) {
++               dbg ("adc wrong sample, read %x got %x", adcsel,
++               *sample & WM97XX_ADCSEL_MASK);
++               return RC_PENUP;
++       }
++
++       if (!(*sample & WM97XX_PEN_DOWN)) {
++               wm->pen_probably_down = 0;
++               return RC_PENUP;
++       }
++
++       return RC_VALID;
++}
++
++/*
++ * Read a coord from the WM9712 adc in polling mode.
++ */
++static int wm9712_poll_coord (struct wm97xx* wm, struct wm97xx_data *data)
++{
++       int timeout = 5 * delay;
++
++       if (!wm->pen_probably_down) {
++               u16 data = wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER_RD);
++               if (!(data & WM97XX_PEN_DOWN))
++                       return RC_PENUP;
++               wm->pen_probably_down = 1;
++       }
++
++       /* set up digitiser */
++       if (wm->mach_ops && wm->mach_ops->pre_sample)
++               wm->mach_ops->pre_sample(WM97XX_ADCSEL_X | WM97XX_ADCSEL_Y);
++
++       wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER1,
++               WM97XX_COO | WM97XX_POLL | WM97XX_DELAY(delay));
++
++       /* wait 3 AC97 time slots + delay for conversion and read x */
++       poll_delay(delay);
++       data->x = wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER_RD);
++       /* wait for POLL to go low */
++       while ((wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER1) & WM97XX_POLL) && timeout) {
++               udelay(AC97_LINK_FRAME);
++               timeout--;
++       }
++
++       if (timeout <= 0) {
++               /* If PDEN is set, we can get a timeout when pen goes up */
++               if (is_pden(wm))
++                       wm->pen_probably_down = 0;
++               else
++                       dbg ("adc sample timeout");
++               return RC_PENUP;
++       }
++
++       /* read back y data */
++       data->y = wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER_RD);
++       if (pil)
++               data->p = wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER_RD);
++       else
++               data->p = DEFAULT_PRESSURE;
++
++       if (wm->mach_ops && wm->mach_ops->post_sample)
++               wm->mach_ops->post_sample(WM97XX_ADCSEL_X | WM97XX_ADCSEL_Y);
++
++       /* check we have correct sample */
++       if (!(data->x & WM97XX_ADCSEL_X) || !(data->y & WM97XX_ADCSEL_Y))
++               goto err;
++       if(pil && !(data->p & WM97XX_ADCSEL_PRES))
++               goto err;
++
++       if (!(data->x & WM97XX_PEN_DOWN)) {
++               wm->pen_probably_down = 0;
++               return RC_PENUP;
++       }
++       return RC_VALID;
++err:
++       return RC_PENUP;
++}
++
++/*
++ * Sample the WM9712 touchscreen in polling mode
++ */
++static int wm9712_poll_touch(struct wm97xx* wm, struct wm97xx_data *data)
++{
++       int rc;
++
++       if(coord) {
++               if((rc = wm9712_poll_coord(wm, data)) != RC_VALID)
++                       return rc;
++       } else {
++               if ((rc = wm9712_poll_sample(wm, WM97XX_ADCSEL_X, &data->x)) != RC_VALID)
++                       return rc;
++
++               if ((rc = wm9712_poll_sample(wm, WM97XX_ADCSEL_Y, &data->y)) != RC_VALID)
++                       return rc;
++
++               if (pil && !five_wire) {
++                       if ((rc = wm9712_poll_sample(wm, WM97XX_ADCSEL_PRES, &data->p)) != RC_VALID)
++                               return rc;
++               } else
++                       data->p = DEFAULT_PRESSURE;
++       }
++       return RC_VALID;
++}
++
++/*
++ * Enable WM9712 continuous mode, i.e. touch data is streamed across an AC97 slot
++ */
++static int wm9712_acc_enable (struct wm97xx* wm, int enable)
++{
++       u16 dig1, dig2;
++       int ret = 0;
++
++       dig1 = wm->dig[1];
++       dig2 = wm->dig[2];
++
++       if (enable) {
++               /* continous mode */
++               if (wm->mach_ops->acc_startup && (ret = wm->mach_ops->acc_startup(wm)) < 0)
++                       return ret;
++               dig1 &= ~(WM97XX_CM_RATE_MASK | WM97XX_ADCSEL_MASK |
++                       WM97XX_DELAY_MASK | WM97XX_SLT_MASK);
++               dig1 |= WM97XX_CTC | WM97XX_COO | WM97XX_SLEN |
++                       WM97XX_DELAY (delay) |
++                       WM97XX_SLT (wm->acc_slot) |
++                       WM97XX_RATE (wm->acc_rate);
++               if (pil)
++                       dig1 |= WM97XX_ADCSEL_PRES;
++               dig2 |= WM9712_PDEN;
++       } else {
++               dig1 &= ~(WM97XX_CTC | WM97XX_COO | WM97XX_SLEN);
++               dig2 &= ~WM9712_PDEN;
++               if (wm->mach_ops->acc_shutdown)
++                       wm->mach_ops->acc_shutdown(wm);
++       }
++
++       wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER1, dig1);
++       wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER2, dig2);
++       return 0;
++}
++
++struct wm97xx_codec_drv wm97xx_codec = {
++       .id =   WM9712_ID2,
++       .name = "wm9712",
++       .poll_sample = wm9712_poll_sample,
++       .poll_touch = wm9712_poll_touch,
++       .acc_enable = wm9712_acc_enable,
++       .digitiser_ioctl = wm9712_digitiser_ioctl,
++};
++
++EXPORT_SYMBOL_GPL(wm97xx_codec);
++
++/* Module information */
++MODULE_AUTHOR("Liam Girdwood, liam.girdwood@wolfsonmicro.com, www.wolfsonmicro.com");
++MODULE_DESCRIPTION("WM9712 Touch Screen Driver");
++MODULE_LICENSE("GPL");
+Index: linux-2.6.17/drivers/input/touchscreen/wm9713.c
+===================================================================
+--- /dev/null   1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.17/drivers/input/touchscreen/wm9713.c     2006-09-19 20:36:47.969052000 +0200
+@@ -0,0 +1,461 @@
++/*
++ * wm9713.c  --  Codec touch driver for Wolfson WM9713 AC97 Codec.
++ *
++ * Copyright 2003, 2004, 2005, 2006 Wolfson Microelectronics PLC.
++ * Author: Liam Girdwood
++ *         liam.girdwood@wolfsonmicro.com or linux@wolfsonmicro.com
++ * Parts Copyright : Ian Molton <spyro@f2s.com>
++ *                   Andrew Zabolotny <zap@homelink.ru>
++ *                   Russell King <rmk@arm.linux.org.uk>
++ *
++ *  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.
++ *
++ *  Revision history
++ *     6th Sep 2006  Mike Arthur <linux@wolfsonmicro.com>
++ *                   Added pre and post sample calls.
++ *
++ */
++
++#include <linux/module.h>
++#include <linux/moduleparam.h>
++#include <linux/version.h>
++#include <linux/kernel.h>
++#include <linux/input.h>
++#include <linux/delay.h>
++#include <linux/bitops.h>
++#include <linux/wm97xx.h>
++
++#define TS_NAME                        "wm97xx"
++#define WM9713_VERSION         "0.53"
++#define DEFAULT_PRESSURE       0xb0c0
++
++/*
++ * Debug
++ */
++#if 0
++#define dbg(format, arg...) printk(KERN_DEBUG TS_NAME ": " format "\n" , ## arg)
++#else
++#define dbg(format, arg...)
++#endif
++#define err(format, arg...) printk(KERN_ERR TS_NAME ": " format "\n" , ## arg)
++#define info(format, arg...) printk(KERN_INFO TS_NAME ": " format "\n" , ## arg)
++#define warn(format, arg...) printk(KERN_WARNING TS_NAME ": " format "\n" , ## arg)
++
++/*
++ * Module parameters
++ */
++
++/*
++ * Set internal pull up for pen detect.
++ *
++ * Pull up is in the range 1.02k (least sensitive) to 64k (most sensitive)
++ * i.e. pull up resistance = 64k Ohms / rpu.
++ *
++ * Adjust this value if you are having problems with pen detect not
++ * detecting any down event.
++ */
++static int rpu = 1;
++module_param(rpu, int, 0);
++MODULE_PARM_DESC(rpu, "Set internal pull up resitor for pen detect.");
++
++/*
++ * Set current used for pressure measurement.
++ *
++ * Set pil = 2 to use 400uA
++ *     pil = 1 to use 200uA and
++ *     pil = 0 to disable pressure measurement.
++ *
++ * This is used to increase the range of values returned by the adc
++ * when measureing touchpanel pressure.
++ */
++static int pil = 0;
++module_param(pil, int, 0);
++MODULE_PARM_DESC(pil, "Set current used for pressure measurement.");
++
++/*
++ * Set threshold for pressure measurement.
++ *
++ * Pen down pressure below threshold is ignored.
++ */
++static int pressure = DEFAULT_PRESSURE & 0xfff;
++module_param(pressure, int, 0);
++MODULE_PARM_DESC(pressure, "Set threshold for pressure measurement.");
++
++/*
++ * Set adc sample delay.
++ *
++ * For accurate touchpanel measurements, some settling time may be
++ * required between the switch matrix applying a voltage across the
++ * touchpanel plate and the ADC sampling the signal.
++ *
++ * This delay can be set by setting delay = n, where n is the array
++ * position of the delay in the array delay_table below.
++ * Long delays > 1ms are supported for completeness, but are not
++ * recommended.
++ */
++static int delay = 4;
++module_param(delay, int, 0);
++MODULE_PARM_DESC(delay, "Set adc sample delay.");
++
++/*
++ * Set adc mask function.
++ *
++ * Sources of glitch noise, such as signals driving an LCD display, may feed
++ * through to the touch screen plates and affect measurement accuracy. In
++ * order to minimise this, a signal may be applied to the MASK pin to delay or
++ * synchronise the sampling.
++ *
++ * 0 = No delay or sync
++ * 1 = High on pin stops conversions
++ * 2 = Edge triggered, edge on pin delays conversion by delay param (above)
++ * 3 = Edge triggered, edge on pin starts conversion after delay param
++ */
++static int mask = 0;
++module_param(mask, int, 0);
++MODULE_PARM_DESC(mask, "Set adc mask function.");
++
++/*
++ * Coordinate Polling Enable.
++ *
++ * Set to 1 to enable coordinate polling. e.g. x,y[,p] is sampled together
++ * for every poll.
++ */
++static int coord = 1;
++module_param(coord, int, 0);
++MODULE_PARM_DESC(coord, "Polling coordinate mode");
++
++/*
++ * ADC sample delay times in uS
++ */
++static const int delay_table[] = {
++       21,    // 1 AC97 Link frames
++       42,    // 2
++       84,    // 4
++       167,   // 8
++       333,   // 16
++       667,   // 32
++       1000,  // 48
++       1333,  // 64
++       2000,  // 96
++       2667,  // 128
++       3333,  // 160
++       4000,  // 192
++       4667,  // 224
++       5333,  // 256
++       6000,  // 288
++       0      // No delay, switch matrix always on
++};
++
++/*
++ * Delay after issuing a POLL command.
++ *
++ * The delay is 3 AC97 link frames + the touchpanel settling delay
++ */
++static inline void poll_delay(int d)
++{
++       udelay (3 * AC97_LINK_FRAME + delay_table [d]);
++}
++
++/*
++ * set up the physical settings of the WM9713
++ */
++static void init_wm9713_phy(struct wm97xx* wm)
++{
++       u16 dig1 = 0, dig2, dig3;
++
++       /* default values */
++       dig2 = WM97XX_DELAY(4) | WM97XX_SLT(5);
++       dig3= WM9712_RPU(1);
++
++       /* rpu */
++       if (rpu) {
++               dig3 &= 0xffc0;
++               dig3 |= WM9712_RPU(rpu);
++               info("setting pen detect pull-up to %d Ohms",64000 / rpu);
++       }
++
++       /* touchpanel pressure */
++       if (pil == 2) {
++               dig3 |= WM9712_PIL;
++               info("setting pressure measurement current to 400uA.");
++       } else if (pil)
++               info ("setting pressure measurement current to 200uA.");
++       if(!pil)
++               pressure = 0;
++
++       /* sample settling delay */
++       if (delay < 0 || delay > 15) {
++               info ("supplied delay out of range.");
++               delay = 4;
++               info("setting adc sample delay to %d u Secs.", delay_table[delay]);
++       }
++       dig2 &= 0xff0f;
++       dig2 |= WM97XX_DELAY(delay);
++
++       /* mask */
++       dig3 |= ((mask & 0x3) << 4);
++       if(coord)
++               dig3 |= WM9713_WAIT;
++
++       wm->misc = wm97xx_reg_read(wm, 0x5a);
++
++       wm97xx_reg_write(wm, AC97_WM9713_DIG1, dig1);
++       wm97xx_reg_write(wm, AC97_WM9713_DIG2, dig2);
++       wm97xx_reg_write(wm, AC97_WM9713_DIG3, dig3);
++       wm97xx_reg_write(wm, AC97_GPIO_STICKY, 0x0);
++}
++
++static int wm9713_digitiser_ioctl(struct wm97xx* wm, int cmd)
++{
++       u16 val = 0;
++
++       switch(cmd){
++       case WM97XX_DIG_START:
++               val = wm97xx_reg_read(wm, AC97_EXTENDED_MID);
++               wm97xx_reg_write(wm, AC97_EXTENDED_MID, val & 0x7fff);
++               wm97xx_reg_write(wm, AC97_WM9713_DIG3, wm->dig[2] | WM97XX_PRP_DET_DIG);
++               wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER_RD); /* dummy read */
++               break;
++       case WM97XX_DIG_STOP:
++               wm97xx_reg_write(wm, AC97_WM9713_DIG3, wm->dig[2] & ~WM97XX_PRP_DET_DIG);
++               val = wm97xx_reg_read(wm, AC97_EXTENDED_MID);
++               wm97xx_reg_write(wm, AC97_EXTENDED_MID, val | 0x8000);
++               break;
++       case WM97XX_AUX_PREPARE:
++               memcpy(wm->dig_save, wm->dig, sizeof(wm->dig));
++               wm97xx_reg_write(wm, AC97_WM9713_DIG1, 0);
++               wm97xx_reg_write(wm, AC97_WM9713_DIG2, 0);
++               wm97xx_reg_write(wm, AC97_WM9713_DIG3, WM97XX_PRP_DET_DIG);
++               break;
++       case WM97XX_DIG_RESTORE:
++               wm97xx_reg_write(wm, AC97_WM9713_DIG1, wm->dig_save[0]);
++               wm97xx_reg_write(wm, AC97_WM9713_DIG2, wm->dig_save[1]);
++               wm97xx_reg_write(wm, AC97_WM9713_DIG3, wm->dig_save[2]);
++               break;
++       case WM97XX_PHY_INIT:
++               init_wm9713_phy(wm);
++               break;
++       default:
++               return -EINVAL;
++       }
++       return 0;
++}
++
++static inline int is_pden (struct wm97xx* wm)
++{
++       return wm->dig[2] & WM9713_PDEN;
++}
++
++/*
++ * Read a sample from the WM9713 adc in polling mode.
++ */
++static int wm9713_poll_sample (struct wm97xx* wm, int adcsel, int *sample)
++{
++       u16 dig1;
++       int timeout = 5 * delay;
++
++       if (!wm->pen_probably_down) {
++               u16 data = wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER_RD);
++               if (!(data & WM97XX_PEN_DOWN))
++                       return RC_PENUP;
++               wm->pen_probably_down = 1;
++       }
++
++       /* set up digitiser */
++       if (adcsel & 0x8000)
++               adcsel = 1 << ((adcsel & 0x7fff) + 3);
++
++       dig1 = wm97xx_reg_read(wm, AC97_WM9713_DIG1);
++       dig1 &= ~WM9713_ADCSEL_MASK;
++
++       if (wm->mach_ops && wm->mach_ops->pre_sample)
++               wm->mach_ops->pre_sample(adcsel);
++       wm97xx_reg_write(wm, AC97_WM9713_DIG1, dig1 | adcsel |WM9713_POLL);
++
++       /* wait 3 AC97 time slots + delay for conversion */
++       poll_delay(delay);
++
++       /* wait for POLL to go low */
++       while ((wm97xx_reg_read(wm, AC97_WM9713_DIG1) & WM9713_POLL) && timeout) {
++               udelay(AC97_LINK_FRAME);
++               timeout--;
++       }
++
++       if (timeout <= 0) {
++               /* If PDEN is set, we can get a timeout when pen goes up */
++               if (is_pden(wm))
++                       wm->pen_probably_down = 0;
++               else
++                       dbg ("adc sample timeout");
++               return RC_PENUP;
++       }
++
++       *sample =wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER_RD);
++       if (wm->mach_ops && wm->mach_ops->post_sample)
++               wm->mach_ops->post_sample(adcsel);
++
++       /* check we have correct sample */
++       if ((*sample & WM97XX_ADCSRC_MASK) != ffs(adcsel >> 1) << 12) {
++               dbg ("adc wrong sample, read %x got %x", adcsel,
++                    *sample & WM97XX_ADCSRC_MASK);
++               return RC_PENUP;
++       }
++
++       if (!(*sample & WM97XX_PEN_DOWN)) {
++               wm->pen_probably_down = 0;
++               return RC_PENUP;
++       }
++
++       return RC_VALID;
++}
++
++/*
++ * Read a coordinate from the WM9713 adc in polling mode.
++ */
++static int wm9713_poll_coord (struct wm97xx* wm, struct wm97xx_data *data)
++{
++       u16 dig1;
++       int timeout = 5 * delay;
++
++       if (!wm->pen_probably_down) {
++               u16 data = wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER_RD);
++               if (!(data & WM97XX_PEN_DOWN))
++                       return RC_PENUP;
++               wm->pen_probably_down = 1;
++       }
++
++       /* set up digitiser */
++       dig1 = wm97xx_reg_read(wm, AC97_WM9713_DIG1);
++       dig1 &= ~WM9713_ADCSEL_MASK;
++       if(pil)
++               dig1 |= WM97XX_ADCSEL_PRES;
++
++       if (wm->mach_ops && wm->mach_ops->pre_sample)
++               wm->mach_ops->pre_sample(WM97XX_ADCSEL_X | WM97XX_ADCSEL_Y);
++       wm97xx_reg_write(wm, AC97_WM9713_DIG1, dig1 | WM9713_POLL | WM9713_COO);
++
++       /* wait 3 AC97 time slots + delay for conversion */
++       poll_delay(delay);
++       data->x = wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER_RD);
++       /* wait for POLL to go low */
++       while ((wm97xx_reg_read(wm, AC97_WM9713_DIG1) & WM9713_POLL) && timeout) {
++               udelay(AC97_LINK_FRAME);
++               timeout--;
++       }
++
++       if (timeout <= 0) {
++               /* If PDEN is set, we can get a timeout when pen goes up */
++               if (is_pden(wm))
++                       wm->pen_probably_down = 0;
++               else
++                       dbg ("adc sample timeout");
++               return RC_PENUP;
++       }
++
++       /* read back data */
++       data->y = wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER_RD);
++       if (pil)
++               data->p = wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER_RD);
++       else
++               data->p = DEFAULT_PRESSURE;
++
++       if (wm->mach_ops && wm->mach_ops->post_sample)
++               wm->mach_ops->post_sample(WM97XX_ADCSEL_X | WM97XX_ADCSEL_Y);
++
++       /* check we have correct sample */
++       if (!(data->x & WM97XX_ADCSEL_X) || !(data->y & WM97XX_ADCSEL_Y))
++               goto err;
++       if(pil && !(data->p & WM97XX_ADCSEL_PRES))
++               goto err;
++
++       if (!(data->x & WM97XX_PEN_DOWN)) {
++               wm->pen_probably_down = 0;
++               return RC_PENUP;
++       }
++       return RC_VALID;
++err:
++       return RC_PENUP;
++}
++
++/*
++ * Sample the WM9713 touchscreen in polling mode
++ */
++static int wm9713_poll_touch(struct wm97xx* wm, struct wm97xx_data *data)
++{
++       int rc;
++
++       if(coord) {
++               if((rc = wm9713_poll_coord(wm, data)) != RC_VALID)
++                       return rc;
++       } else {
++               if ((rc = wm9713_poll_sample(wm, WM9713_ADCSEL_X, &data->x)) != RC_VALID)
++                       return rc;
++               if ((rc = wm9713_poll_sample(wm, WM9713_ADCSEL_Y, &data->y)) != RC_VALID)
++                       return rc;
++               if (pil) {
++                       if ((rc = wm9713_poll_sample(wm, WM9713_ADCSEL_PRES, &data->p)) != RC_VALID)
++                               return rc;
++               } else
++                       data->p = DEFAULT_PRESSURE;
++       }
++       return RC_VALID;
++}
++
++/*
++ * Enable WM9713 continuous mode, i.e. touch data is streamed across an AC97 slot
++ */
++static int wm9713_acc_enable (struct wm97xx* wm, int enable)
++{
++       u16 dig1, dig2, dig3;
++       int ret = 0;
++
++       dig1 = wm->dig[0];
++       dig2 = wm->dig[1];
++       dig3 = wm->dig[2];
++
++       if (enable) {
++               /* continous mode */
++               if (wm->mach_ops->acc_startup &&
++                       (ret = wm->mach_ops->acc_startup(wm)) < 0)
++                       return ret;
++
++               dig1 &= ~WM9713_ADCSEL_MASK;
++               dig1 |= WM9713_CTC | WM9713_COO | WM9713_ADCSEL_X | WM9713_ADCSEL_Y;
++        if (pil)
++               dig1 |= WM9713_ADCSEL_PRES;
++               dig2 &= ~(WM97XX_DELAY_MASK | WM97XX_SLT_MASK  | WM97XX_CM_RATE_MASK);
++               dig2 |= WM97XX_SLEN | WM97XX_DELAY (delay) |
++               WM97XX_SLT (wm->acc_slot) | WM97XX_RATE (wm->acc_rate);
++               dig3 |= WM9713_PDEN;
++       } else {
++               dig1 &= ~(WM9713_CTC | WM9713_COO);
++               dig2 &= ~WM97XX_SLEN;
++               dig3 &= ~WM9713_PDEN;
++        if (wm->mach_ops->acc_shutdown)
++            wm->mach_ops->acc_shutdown(wm);
++       }
++
++       wm97xx_reg_write(wm, AC97_WM9713_DIG1, dig1);
++       wm97xx_reg_write(wm, AC97_WM9713_DIG2, dig2);
++       wm97xx_reg_write(wm, AC97_WM9713_DIG3, dig3);
++       return ret;
++}
++
++struct wm97xx_codec_drv wm97xx_codec = {
++       .id =   WM9713_ID2,
++    .name = "wm9713",
++       .poll_sample = wm9713_poll_sample,
++       .poll_touch = wm9713_poll_touch,
++       .acc_enable = wm9713_acc_enable,
++       .digitiser_ioctl = wm9713_digitiser_ioctl,
++};
++
++EXPORT_SYMBOL_GPL(wm97xx_codec);
++
++/* Module information */
++MODULE_AUTHOR("Liam Girdwood, liam.girdwood@wolfsonmicro.com, www.wolfsonmicro.com");
++MODULE_DESCRIPTION("WM9713 Touch Screen Driver");
++MODULE_LICENSE("GPL");
+Index: linux-2.6.17/drivers/input/touchscreen/wm97xx-core.c
+===================================================================
+--- /dev/null   1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.17/drivers/input/touchscreen/wm97xx-core.c        2006-09-19 20:36:47.969052000 +0200
+@@ -0,0 +1,912 @@
++/*
++ * wm97xx-core.c  --  Touch screen driver core for Wolfson WM9705, WM9712
++ *                    and WM9713 AC97 Codecs.
++ *
++ * Copyright 2003, 2004, 2005, 2006 Wolfson Microelectronics PLC.
++ * Author: Liam Girdwood
++ *         liam.girdwood@wolfsonmicro.com or linux@wolfsonmicro.com
++ * Parts Copyright : Ian Molton <spyro@f2s.com>
++ *                   Andrew Zabolotny <zap@homelink.ru>
++ *                   Russell King <rmk@arm.linux.org.uk>
++ *
++ *  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.
++ *
++ * Notes:
++ *
++ *  Features:
++ *       - supports WM9705, WM9712, WM9713
++ *       - polling mode
++ *       - continuous mode (arch-dependent)
++ *       - adjustable rpu/dpp settings
++ *       - adjustable pressure current
++ *       - adjustable sample settle delay
++ *       - 4 and 5 wire touchscreens (5 wire is WM9712 only)
++ *       - pen down detection
++ *       - battery monitor
++ *       - sample AUX adc's
++ *       - power management
++ *       - codec GPIO
++ *       - codec event notification
++ * Todo
++ *       - Support for async sampling control for noisy LCD's.
++ *
++ *  Revision history
++ *    7th May 2003   Initial version.
++ *    6th June 2003  Added non module support and AC97 registration.
++ *   18th June 2003  Added AUX adc sampling.
++ *   23rd June 2003  Did some minimal reformatting, fixed a couple of
++ *                   codec_mutexing bugs and noted a race to fix.
++ *   24th June 2003  Added power management and fixed race condition.
++ *   10th July 2003  Changed to a misc device.
++ *   31st July 2003  Moved TS_EVENT and TS_CAL to wm97xx.h
++ *    8th Aug  2003  Added option for read() calling wm97xx_sample_touch()
++ *                   because some ac97_read/ac_97_write call schedule()
++ *    7th Nov  2003  Added Input touch event interface, stanley.cai@intel.com
++ *   13th Nov  2003  Removed h3600 touch interface, added interrupt based
++ *                   pen down notification and implemented continous mode
++ *                   on XScale arch.
++ *   16th Nov  2003  Ian Molton <spyro@f2s.com>
++ *                   Modified so that it suits the new 2.6 driver model.
++ *   25th Jan  2004  Andrew Zabolotny <zap@homelink.ru>
++ *                   Implemented IRQ-driven pen down detection, implemented
++ *                   the private API meant to be exposed to platform-specific
++ *                   drivers, reorganized the driver so that it supports
++ *                   an arbitrary number of devices.
++ *    1st Feb  2004  Moved continuous mode handling to a separate
++ *                   architecture-dependent file. For now only PXA
++ *                   built-in AC97 controller is supported (pxa-ac97-wm97xx.c).
++ *    11th Feb 2004  Reduced CPU usage by keeping a cached copy of both
++ *                   digitizer registers instead of reading them every time.
++ *                   A reorganization of the whole code for better
++ *                   error handling.
++ *    17th Apr 2004  Added BMON support.
++ *    17th Nov 2004  Added codec GPIO, codec event handling (real and virtual
++ *                   GPIOs) and 2.6 power management.
++ *    29th Nov 2004  Added WM9713 support.
++ *     4th Jul 2005  Moved codec specific code out to seperate files.
++ *     6th Sep 2006  Mike Arthur <linux@wolfsonmicro.com>
++ *                   Added bus interface.
++ */
++
++#include <linux/module.h>
++#include <linux/moduleparam.h>
++#include <linux/version.h>
++#include <linux/kernel.h>
++#include <linux/init.h>
++#include <linux/delay.h>
++#include <linux/string.h>
++#include <linux/proc_fs.h>
++#include <linux/pm.h>
++#include <linux/interrupt.h>
++#include <linux/bitops.h>
++#include <linux/workqueue.h>
++#include <linux/device.h>
++#include <linux/wm97xx.h>
++#include <asm/uaccess.h>
++#include <asm/io.h>
++
++#define TS_NAME                        "wm97xx"
++#define WM_CORE_VERSION                "0.63"
++#define DEFAULT_PRESSURE       0xb0c0
++
++/*
++ * WM97xx - enable/disable AUX ADC sysfs
++ */
++static int aux_sys = 1;
++module_param(aux_sys, int, 0);
++MODULE_PARM_DESC(aux_sys, "enable AUX ADC sysfs entries");
++
++/*
++ * WM97xx - enable/disable codec status sysfs
++ */
++static int status_sys = 1;
++module_param(status_sys, int, 0);
++MODULE_PARM_DESC(status_sys, "enable codec status sysfs entries");
++
++/*
++ * Touchscreen absolute values
++ *
++ * These parameters are used to help the input layer discard out of
++ * range readings and reduce jitter etc.
++ *
++ *   o min, max:- indicate the min and max values your touch screen returns
++ *   o fuzz:- use a higher number to reduce jitter
++ *
++ * The default values correspond to Mainstone II in QVGA mode
++ *
++ * Please read
++ * Documentation/input/input-programming.txt for more details.
++ */
++
++static int abs_x[3] = {350,3900,5};
++module_param_array(abs_x, int, NULL, 0);
++MODULE_PARM_DESC(abs_x, "Touchscreen absolute X min, max, fuzz");
++
++static int abs_y[3] = {320,3750,40};
++module_param_array(abs_y, int, NULL, 0);
++MODULE_PARM_DESC(abs_y, "Touchscreen absolute Y min, max, fuzz");
++
++static int abs_p[3] = {0,150,4};
++module_param_array(abs_p, int, NULL, 0);
++MODULE_PARM_DESC(abs_p, "Touchscreen absolute Pressure min, max, fuzz");
++
++/*
++ * Debug
++ */
++#if 0
++#define dbg(format, arg...) printk(KERN_DEBUG TS_NAME ": " format "\n" , ## arg)
++#else
++#define dbg(format, arg...)
++#endif
++#define err(format, arg...) printk(KERN_ERR TS_NAME ": " format "\n" , ## arg)
++#define info(format, arg...) printk(KERN_INFO TS_NAME ": " format "\n" , ## arg)
++#define warn(format, arg...) printk(KERN_WARNING TS_NAME ": " format "\n" , ## arg)
++
++/* codec AC97 IO access */
++int wm97xx_reg_read(struct wm97xx *wm, u16 reg)
++{
++       if (wm->ac97)
++               return wm->ac97->bus->ops->read(wm->ac97, reg);
++       else
++               return -1;
++}
++
++void wm97xx_reg_write(struct wm97xx *wm, u16 reg, u16 val)
++{
++       /* cache digitiser registers */
++       if(reg >= AC97_WM9713_DIG1 && reg <= AC97_WM9713_DIG3)
++               wm->dig[(reg - AC97_WM9713_DIG1) >> 1] = val;
++
++       /* cache gpio regs */
++       if(reg >= AC97_GPIO_CFG && reg <= AC97_MISC_AFE)
++               wm->gpio[(reg - AC97_GPIO_CFG) >> 1] = val;
++
++       /* wm9713 irq reg */
++       if(reg == 0x5a)
++               wm->misc = val;
++
++       if (wm->ac97)
++               wm->ac97->bus->ops->write(wm->ac97, reg, val);
++}
++
++
++/**
++ *     wm97xx_read_aux_adc - Read the aux adc.
++ *     @wm: wm97xx device.
++ *  @adcsel: codec ADC to be read
++ *
++ *     Reads the selected AUX ADC.
++ */
++
++int wm97xx_read_aux_adc(struct wm97xx *wm, u16 adcsel)
++{
++       int power_adc = 0, auxval;
++       u16 power = 0;
++
++       /* get codec */
++       mutex_lock(&wm->codec_mutex);
++
++       /* When the touchscreen is not in use, we may have to power up the AUX ADC
++        * before we can use sample the AUX inputs->
++        */
++       if (wm->id == WM9713_ID2 &&
++           (power = wm97xx_reg_read(wm, AC97_EXTENDED_MID)) & 0x8000) {
++               power_adc = 1;
++               wm97xx_reg_write(wm, AC97_EXTENDED_MID, power & 0x7fff);
++       }
++
++       /* Prepare the codec for AUX reading */
++       wm->codec->digitiser_ioctl(wm, WM97XX_AUX_PREPARE);
++
++       /* Turn polling mode on to read AUX ADC */
++       wm->pen_probably_down = 1;
++       wm->codec->poll_sample(wm, adcsel, &auxval);
++
++       if (power_adc)
++               wm97xx_reg_write(wm, AC97_EXTENDED_MID, power | 0x8000);
++
++       wm->codec->digitiser_ioctl(wm, WM97XX_DIG_RESTORE);
++
++       wm->pen_probably_down = 0;
++
++       mutex_unlock(&wm->codec_mutex);
++       return auxval & 0xfff;
++}
++
++#define WM97XX_AUX_ATTR(name,input) \
++static ssize_t name##_show(struct device *dev, struct device_attribute *attr, char *buf)   \
++{ \
++       struct wm97xx *wm = (struct wm97xx*)dev->driver_data; \
++       return sprintf(buf, "%d\n", wm97xx_read_aux_adc(wm, input)); \
++} \
++static DEVICE_ATTR(name, 0444, name##_show, NULL)
++
++WM97XX_AUX_ATTR(aux1, WM97XX_AUX_ID1);
++WM97XX_AUX_ATTR(aux2, WM97XX_AUX_ID2);
++WM97XX_AUX_ATTR(aux3, WM97XX_AUX_ID3);
++WM97XX_AUX_ATTR(aux4, WM97XX_AUX_ID4);
++
++#define WM97XX_STATUS_ATTR(name) \
++static ssize_t name##_show(struct device *dev, struct device_attribute *attr, char *buf)   \
++{ \
++       struct wm97xx *wm = (struct wm97xx*)dev->driver_data; \
++       return sprintf(buf, "%d\n", wm97xx_reg_read(wm, AC97_GPIO_STATUS)); \
++} \
++static DEVICE_ATTR(name, 0444, name##_show, NULL)
++
++WM97XX_STATUS_ATTR(gpio);
++
++static int wm97xx_sys_add(struct device *dev)
++{
++       if (aux_sys) {
++               device_create_file(dev, &dev_attr_aux1);
++               device_create_file(dev, &dev_attr_aux2);
++               device_create_file(dev, &dev_attr_aux3);
++               device_create_file(dev, &dev_attr_aux4);
++       }
++       if (status_sys)
++               device_create_file(dev, &dev_attr_gpio);
++       return 0;
++}
++
++static void wm97xx_sys_remove(struct device *dev)
++{
++       if (status_sys)
++               device_remove_file(dev, &dev_attr_gpio);
++       if (aux_sys) {
++               device_remove_file(dev, &dev_attr_aux1);
++               device_remove_file(dev, &dev_attr_aux2);
++               device_remove_file(dev, &dev_attr_aux3);
++               device_remove_file(dev, &dev_attr_aux4);
++       }
++}
++
++/**
++ *     wm97xx_get_gpio - Get the status of a codec GPIO.
++ *     @wm: wm97xx device.
++ *  @gpio: gpio
++ *
++ *     Get the status of a codec GPIO pin
++ */
++
++wm97xx_gpio_status_t wm97xx_get_gpio(struct wm97xx *wm, u32 gpio)
++{
++       u16 status;
++       wm97xx_gpio_status_t ret;
++
++       mutex_lock(&wm->codec_mutex);
++       status = wm97xx_reg_read(wm, AC97_GPIO_STATUS);
++
++       if (status & gpio)
++               ret = WM97XX_GPIO_HIGH;
++       else
++               ret = WM97XX_GPIO_LOW;
++
++       mutex_unlock(&wm->codec_mutex);
++       return ret;
++}
++
++/**
++ *     wm97xx_set_gpio - Set the status of a codec GPIO.
++ *     @wm: wm97xx device.
++ *  @gpio: gpio
++ *
++ *
++ *     Set the status of a codec GPIO pin
++ */
++
++void wm97xx_set_gpio(struct wm97xx *wm, u32 gpio,
++                               wm97xx_gpio_status_t status)
++{
++       u16 reg;
++
++       mutex_lock(&wm->codec_mutex);
++       reg = wm97xx_reg_read(wm, AC97_GPIO_STATUS);
++
++       if (status & WM97XX_GPIO_HIGH)
++               reg |= gpio;
++       else
++               reg &= ~gpio;
++
++       if (wm->id == WM9712_ID2)
++               wm97xx_reg_write(wm, AC97_GPIO_STATUS, reg << 1);
++       else
++               wm97xx_reg_write(wm, AC97_GPIO_STATUS, reg);
++       mutex_unlock(&wm->codec_mutex);
++}
++
++/*
++ * Codec GPIO pin configuration, this set's pin direction, polarity,
++ * stickyness and wake up.
++ */
++void wm97xx_config_gpio(struct wm97xx *wm, u32 gpio, wm97xx_gpio_dir_t dir,
++                  wm97xx_gpio_pol_t pol, wm97xx_gpio_sticky_t sticky,
++                  wm97xx_gpio_wake_t wake)
++{
++       u16 reg;
++
++       mutex_lock(&wm->codec_mutex);
++       reg = wm97xx_reg_read(wm, AC97_GPIO_POLARITY);
++
++       if (pol == WM97XX_GPIO_POL_HIGH)
++               reg |= gpio;
++       else
++               reg &= ~gpio;
++
++       wm97xx_reg_write(wm, AC97_GPIO_POLARITY, reg);
++       reg = wm97xx_reg_read(wm, AC97_GPIO_STICKY);
++
++       if (sticky == WM97XX_GPIO_STICKY)
++               reg |= gpio;
++       else
++               reg &= ~gpio;
++
++       wm97xx_reg_write(wm, AC97_GPIO_STICKY, reg);
++       reg = wm97xx_reg_read(wm, AC97_GPIO_WAKEUP);
++
++       if (wake == WM97XX_GPIO_WAKE)
++               reg |= gpio;
++       else
++               reg &= ~gpio;
++
++       wm97xx_reg_write(wm, AC97_GPIO_WAKEUP, reg);
++       reg = wm97xx_reg_read(wm, AC97_GPIO_CFG);
++
++       if (dir == WM97XX_GPIO_IN)
++               reg |= gpio;
++       else
++               reg &= ~gpio;
++
++       wm97xx_reg_write(wm, AC97_GPIO_CFG, reg);
++       mutex_unlock(&wm->codec_mutex);
++}
++
++/*
++ * Handle a pen down interrupt.
++ */
++static void wm97xx_pen_irq_worker(void *ptr)
++{
++       struct wm97xx *wm = (struct wm97xx *) ptr;
++
++       /* do we need to enable the touch panel reader */
++       if (wm->id == WM9705_ID2) {
++               if (wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER_RD) & WM97XX_PEN_DOWN)
++                       wm->pen_is_down = 1;
++               else
++                       wm->pen_is_down = 0;
++               wake_up_interruptible(&wm->pen_irq_wait);
++       } else {
++               u16 status, pol;
++               mutex_lock(&wm->codec_mutex);
++               status = wm97xx_reg_read(wm, AC97_GPIO_STATUS);
++               pol = wm97xx_reg_read(wm, AC97_GPIO_POLARITY);
++
++               if (WM97XX_GPIO_13 & pol & status) {
++                       wm->pen_is_down = 1;
++                       wm97xx_reg_write(wm, AC97_GPIO_POLARITY, pol & ~WM97XX_GPIO_13);
++               } else {
++                       wm->pen_is_down = 0;
++                   wm97xx_reg_write(wm, AC97_GPIO_POLARITY, pol | WM97XX_GPIO_13);
++               }
++
++               if (wm->id == WM9712_ID2)
++                       wm97xx_reg_write(wm, AC97_GPIO_STATUS, (status & ~WM97XX_GPIO_13) << 1);
++               else
++                       wm97xx_reg_write(wm, AC97_GPIO_STATUS, status & ~WM97XX_GPIO_13);
++               mutex_unlock(&wm->codec_mutex);
++               wake_up_interruptible(&wm->pen_irq_wait);
++       }
++
++       if (!wm->pen_is_down && wm->mach_ops && wm->mach_ops->acc_enabled)
++               wm->mach_ops->acc_pen_up(wm);
++       enable_irq(wm->pen_irq);
++}
++
++/*
++ * Codec PENDOWN irq handler
++ *
++ * We have to disable the codec interrupt in the handler because it can
++ * take upto 1ms to clear the interrupt source. The interrupt is then enabled
++ * again in the slow handler when the source has been cleared.
++ */
++static irqreturn_t wm97xx_pen_interrupt(int irq, void *dev_id,
++                                       struct pt_regs *regs)
++{
++       struct wm97xx *wm = (struct wm97xx *) dev_id;
++       disable_irq(wm->pen_irq);
++       queue_work(wm->pen_irq_workq, &wm->pen_event_work);
++       return IRQ_HANDLED;
++}
++
++/*
++ * initialise pen IRQ handler and workqueue
++ */
++static int wm97xx_init_pen_irq(struct wm97xx *wm)
++{
++       u16 reg;
++
++       INIT_WORK(&wm->pen_event_work, wm97xx_pen_irq_worker, wm);
++       if ((wm->pen_irq_workq =
++               create_singlethread_workqueue("kwm97pen")) == NULL) {
++               err("could not create pen irq work queue");
++               wm->pen_irq = 0;
++               return -EINVAL;
++       }
++
++       if (request_irq (wm->pen_irq, wm97xx_pen_interrupt, SA_SHIRQ, "wm97xx-pen", wm)) {
++               err("could not register codec pen down interrupt, will poll for pen down");
++               destroy_workqueue(wm->pen_irq_workq);
++               wm->pen_irq = 0;
++               return -EINVAL;
++       }
++
++       /* enable PEN down on wm9712/13 */
++       if (wm->id != WM9705_ID2) {
++               reg = wm97xx_reg_read(wm, AC97_MISC_AFE);
++               wm97xx_reg_write(wm, AC97_MISC_AFE, reg & 0xfffb);
++               reg = wm97xx_reg_read(wm, 0x5a);
++               wm97xx_reg_write(wm, 0x5a, reg & ~0x0001);
++       }
++
++       return 0;
++}
++
++/* Private struct for communication between struct wm97xx_tshread
++ * and wm97xx_read_samples */
++struct ts_state {
++       int sleep_time;
++       int min_sleep_time;
++};
++
++static int wm97xx_read_samples(struct wm97xx *wm, struct ts_state *state)
++{
++       struct wm97xx_data data;
++       int rc;
++
++       mutex_lock(&wm->codec_mutex);
++
++    if (wm->mach_ops && wm->mach_ops->acc_enabled)
++          rc = wm->mach_ops->acc_pen_down(wm);
++    else
++        rc = wm->codec->poll_touch(wm, &data);
++
++       if (rc & RC_PENUP) {
++               if (wm->pen_is_down) {
++                       wm->pen_is_down = 0;
++                       dbg("pen up");
++                       input_report_abs(wm->input_dev, ABS_PRESSURE, 0);
++                       input_sync(wm->input_dev);
++               } else if (!(rc & RC_AGAIN)) {
++                       /* We need high frequency updates only while pen is down,
++                       * the user never will be able to touch screen faster than
++                       * a few times per second... On the other hand, when the
++                       * user is actively working with the touchscreen we don't
++                       * want to lose the quick response. So we will slowly
++                       * increase sleep time after the pen is up and quicky
++                       * restore it to ~one task switch when pen is down again.
++                       */
++                       if (state->sleep_time < HZ / 10)
++                               state->sleep_time++;
++               }
++
++       } else if (rc & RC_VALID) {
++               dbg("pen down: x=%x:%d, y=%x:%d, pressure=%x:%d\n",
++                       data.x >> 12, data.x & 0xfff, data.y >> 12,
++                       data.y & 0xfff, data.p >> 12, data.p & 0xfff);
++               input_report_abs(wm->input_dev, ABS_X, data.x & 0xfff);
++               input_report_abs(wm->input_dev, ABS_Y, data.y & 0xfff);
++               input_report_abs(wm->input_dev, ABS_PRESSURE, data.p & 0xfff);
++               input_sync(wm->input_dev);
++               wm->pen_is_down = 1;
++               state->sleep_time = state->min_sleep_time;
++       } else if (rc & RC_PENDOWN) {
++               dbg("pen down");
++               wm->pen_is_down = 1;
++               state->sleep_time = state->min_sleep_time;
++       }
++
++       mutex_unlock(&wm->codec_mutex);
++       return rc;
++}
++
++/*
++* The touchscreen sample reader thread.
++*/
++static int wm97xx_ts_read(void *data)
++{
++       int rc;
++       struct ts_state state;
++       struct wm97xx *wm = (struct wm97xx *) data;
++
++       /* set up thread context */
++       wm->ts_task = current;
++       daemonize("kwm97xxts");
++
++       if (wm->codec == NULL) {
++               wm->ts_task = NULL;
++               printk(KERN_ERR "codec is NULL, bailing\n");
++       }
++
++       complete(&wm->ts_init);
++       wm->pen_is_down = 0;
++       state.min_sleep_time = HZ >= 100 ? HZ / 100 : 1;
++       if (state.min_sleep_time < 1)
++               state.min_sleep_time = 1;
++       state.sleep_time = state.min_sleep_time;
++
++       /* touch reader loop */
++       while (wm->ts_task) {
++               do {
++                       try_to_freeze();
++                       rc = wm97xx_read_samples(wm, &state);
++               } while (rc & RC_AGAIN);
++               if (!wm->pen_is_down && wm->pen_irq) {
++                       /* Nice, we don't have to poll for pen down event */
++                       wait_event_interruptible(wm->pen_irq_wait, wm->pen_is_down);
++               } else {
++                       set_task_state(current, TASK_INTERRUPTIBLE);
++                       schedule_timeout(state.sleep_time);
++               }
++       }
++       complete_and_exit(&wm->ts_exit, 0);
++}
++
++/**
++ *     wm97xx_ts_input_open - Open the touch screen input device.
++ *     @idev:  Input device to be opened.
++ *
++ *     Called by the input sub system to open a wm97xx touchscreen device.
++ *  Starts the touchscreen thread and touch digitiser.
++ */
++static int wm97xx_ts_input_open(struct input_dev *idev)
++{
++       int ret = 0;
++       struct wm97xx *wm = (struct wm97xx *) idev->private;
++
++       mutex_lock(&wm->codec_mutex);
++       /* first time opened ? */
++       if (wm->ts_use_count++ == 0) {
++               /* start touchscreen thread */
++               init_completion(&wm->ts_init);
++               init_completion(&wm->ts_exit);
++               ret = kernel_thread(wm97xx_ts_read, wm, CLONE_KERNEL);
++
++               if (ret >= 0) {
++                       wait_for_completion(&wm->ts_init);
++                       if (wm->ts_task == NULL)
++                               ret = -EINVAL;
++               } else {
++                       mutex_unlock(&wm->codec_mutex);
++                       return ret;
++               }
++
++               /* start digitiser */
++        if (wm->mach_ops && wm->mach_ops->acc_enabled)
++            wm->codec->acc_enable(wm, 1);
++               wm->codec->digitiser_ioctl(wm, WM97XX_DIG_START);
++
++               /* init pen down/up irq handling */
++               if (wm->pen_irq) {
++                       wm97xx_init_pen_irq(wm);
++
++                       if (wm->pen_irq == 0) {
++                               /* we failed to get an irq for pen down events,
++                                * so we resort to polling. kickstart the reader */
++                               wm->pen_is_down = 1;
++                               wake_up_interruptible(&wm->pen_irq_wait);
++                       }
++               }
++       }
++
++       mutex_unlock(&wm->codec_mutex);
++       return 0;
++}
++
++/**
++ *     wm97xx_ts_input_close - Close the touch screen input device.
++ *     @idev:  Input device to be closed.
++ *
++ *     Called by the input sub system to close a wm97xx touchscreen device.
++ *  Kills the touchscreen thread and stops the touch digitiser.
++ */
++
++static void wm97xx_ts_input_close(struct input_dev *idev)
++{
++       struct wm97xx *wm = (struct wm97xx *) idev->private;
++
++       mutex_lock(&wm->codec_mutex);
++       if (--wm->ts_use_count == 0) {
++               /* destroy workqueues and free irqs */
++               if (wm->pen_irq) {
++                       free_irq(wm->pen_irq, wm);
++                       destroy_workqueue(wm->pen_irq_workq);
++               }
++
++               /* kill thread */
++               if (wm->ts_task) {
++                       wm->ts_task = NULL;
++                       wm->pen_is_down = 1;
++                       wake_up_interruptible(&wm->pen_irq_wait);
++                       wait_for_completion(&wm->ts_exit);
++                       wm->pen_is_down = 0;
++               }
++
++               /* stop digitiser */
++               wm->codec->digitiser_ioctl(wm, WM97XX_DIG_STOP);
++               if (wm->mach_ops && wm->mach_ops->acc_enabled)
++                       wm->codec->acc_enable(wm, 0);
++       }
++       mutex_unlock(&wm->codec_mutex);
++}
++
++static int wm97xx_bus_match(struct device *dev, struct device_driver *drv)
++{
++    return !(strcmp(dev->bus_id,drv->name));
++}
++
++/*
++ * The AC97 audio driver will do all the Codec suspend and resume
++ * tasks. This is just for anything machine specific or extra.
++ */
++static int wm97xx_bus_suspend(struct device *dev, pm_message_t state)
++{
++    int ret = 0;
++
++    if (dev->driver && dev->driver->suspend)
++        ret = dev->driver->suspend(dev, state);
++
++    return ret;
++}
++
++static int wm97xx_bus_resume(struct device *dev)
++{
++    int ret = 0;
++
++    if (dev->driver && dev->driver->resume)
++        ret = dev->driver->resume(dev);
++
++    return ret;
++}
++
++struct bus_type wm97xx_bus_type = {
++    .name       = "wm97xx",
++    .match      = wm97xx_bus_match,
++    .suspend    = wm97xx_bus_suspend,
++    .resume     = wm97xx_bus_resume,
++};
++
++static void  wm97xx_release(struct device *dev)
++{
++    kfree(dev);
++}
++
++static int wm97xx_probe(struct device *dev)
++{
++       struct wm97xx* wm;
++       int ret = 0, id = 0;
++
++       if (!(wm = kzalloc(sizeof(struct wm97xx), GFP_KERNEL)))
++               return -ENOMEM;
++    mutex_init(&wm->codec_mutex);
++
++       init_waitqueue_head(&wm->pen_irq_wait);
++       wm->dev = dev;
++       dev->driver_data = wm;
++       wm->ac97 = to_ac97_t(dev);
++
++       /* check that we have a supported codec */
++       if ((id = wm97xx_reg_read(wm, AC97_VENDOR_ID1)) != WM97XX_ID1) {
++               err("could not find a wm97xx, found a %x instead\n", id);
++               kfree(wm);
++               return -ENODEV;
++       }
++
++       wm->id = wm97xx_reg_read(wm, AC97_VENDOR_ID2);
++       if(wm->id != wm97xx_codec.id) {
++               err("could not find a the selected codec, please build for wm97%2x", wm->id & 0xff);
++               kfree(wm);
++               return -ENODEV;
++       }
++
++       if((wm->input_dev = input_allocate_device()) == NULL) {
++        kfree(wm);
++               return -ENOMEM;
++    }
++
++       /* set up touch configuration */
++       info("detected a wm97%2x codec", wm->id & 0xff);
++       wm->input_dev->name = "wm97xx touchscreen";
++       wm->input_dev->open = wm97xx_ts_input_open;
++       wm->input_dev->close = wm97xx_ts_input_close;
++       set_bit(EV_ABS, wm->input_dev->evbit);
++       set_bit(ABS_X, wm->input_dev->absbit);
++       set_bit(ABS_Y, wm->input_dev->absbit);
++       set_bit(ABS_PRESSURE, wm->input_dev->absbit);
++       wm->input_dev->absmax[ABS_X] = abs_x[1];
++       wm->input_dev->absmax[ABS_Y] = abs_y[1];
++       wm->input_dev->absmax[ABS_PRESSURE] = abs_p[1];
++       wm->input_dev->absmin[ABS_X] = abs_x[0];
++       wm->input_dev->absmin[ABS_Y] = abs_y[0];
++       wm->input_dev->absmin[ABS_PRESSURE] = abs_p[0];
++       wm->input_dev->absfuzz[ABS_X] = abs_x[2];
++       wm->input_dev->absfuzz[ABS_Y] = abs_y[2];
++       wm->input_dev->absfuzz[ABS_PRESSURE] = abs_p[2];
++       wm->input_dev->private = wm;
++       wm->codec = &wm97xx_codec;
++       if((ret = input_register_device(wm->input_dev)) < 0) {
++               kfree(wm);
++               return -ENOMEM;
++    }
++
++       if(aux_sys)
++               wm97xx_sys_add(dev);
++
++       /* set up physical characteristics */
++       wm->codec->digitiser_ioctl(wm, WM97XX_PHY_INIT);
++
++       /* load gpio cache */
++       wm->gpio[0] = wm97xx_reg_read(wm, AC97_GPIO_CFG);
++       wm->gpio[1] = wm97xx_reg_read(wm, AC97_GPIO_POLARITY);
++       wm->gpio[2] = wm97xx_reg_read(wm, AC97_GPIO_STICKY);
++       wm->gpio[3] = wm97xx_reg_read(wm, AC97_GPIO_WAKEUP);
++       wm->gpio[4] = wm97xx_reg_read(wm, AC97_GPIO_STATUS);
++       wm->gpio[5] = wm97xx_reg_read(wm, AC97_MISC_AFE);
++
++       /* register our battery device */
++    if (!(wm->battery_dev = kzalloc(sizeof(struct device), GFP_KERNEL))) {
++       ret = -ENOMEM;
++        goto batt_err;
++    }
++    wm->battery_dev->bus = &wm97xx_bus_type;
++    strcpy(wm->battery_dev->bus_id,"wm97xx-battery");
++    wm->battery_dev->driver_data = wm;
++    wm->battery_dev->parent = dev;
++    wm->battery_dev->release = wm97xx_release;
++    if((ret = device_register(wm->battery_dev)) < 0)
++       goto batt_reg_err;
++
++       /* register our extended touch device (for machine specific extensions) */
++    if (!(wm->touch_dev = kzalloc(sizeof(struct device), GFP_KERNEL))) {
++       ret = -ENOMEM;
++        goto touch_err;
++    }
++    wm->touch_dev->bus = &wm97xx_bus_type;
++    strcpy(wm->touch_dev->bus_id,"wm97xx-touchscreen");
++    wm->touch_dev->driver_data = wm;
++    wm->touch_dev->parent = dev;
++    wm->touch_dev->release = wm97xx_release;
++    if((ret = device_register(wm->touch_dev)) < 0)
++       goto touch_reg_err;
++
++    return ret;
++
++touch_reg_err:
++       kfree(wm->touch_dev);
++touch_err:
++    device_unregister(wm->battery_dev);
++batt_reg_err:
++       kfree(wm->battery_dev);
++batt_err:
++    input_unregister_device(wm->input_dev);
++    kfree(wm);
++    return ret;
++}
++
++static int wm97xx_remove(struct device *dev)
++{
++       struct wm97xx *wm = dev_get_drvdata(dev);
++
++       /* Stop touch reader thread */
++       if (wm->ts_task) {
++               wm->ts_task = NULL;
++               wm->pen_is_down = 1;
++               wake_up_interruptible(&wm->pen_irq_wait);
++               wait_for_completion(&wm->ts_exit);
++       }
++       device_unregister(wm->battery_dev);
++       device_unregister(wm->touch_dev);
++    input_unregister_device(wm->input_dev);
++
++       if(aux_sys)
++               wm97xx_sys_remove(dev);
++
++       kfree(wm);
++       return 0;
++}
++
++#ifdef CONFIG_PM
++int wm97xx_resume(struct device* dev)
++{
++       struct wm97xx *wm = dev_get_drvdata(dev);
++
++       /* restore digitiser and gpio's */
++       if(wm->id == WM9713_ID2) {
++               wm97xx_reg_write(wm, AC97_WM9713_DIG1, wm->dig[0]);
++               wm97xx_reg_write(wm, 0x5a, wm->misc);
++               if(wm->ts_use_count) {
++                       u16 reg = wm97xx_reg_read(wm, AC97_EXTENDED_MID) & 0x7fff;
++                       wm97xx_reg_write(wm, AC97_EXTENDED_MID, reg);
++               }
++       }
++
++       wm97xx_reg_write(wm, AC97_WM9713_DIG2, wm->dig[1]);
++       wm97xx_reg_write(wm, AC97_WM9713_DIG3, wm->dig[2]);
++
++       wm97xx_reg_write(wm, AC97_GPIO_CFG, wm->gpio[0]);
++       wm97xx_reg_write(wm, AC97_GPIO_POLARITY, wm->gpio[1]);
++       wm97xx_reg_write(wm, AC97_GPIO_STICKY, wm->gpio[2]);
++       wm97xx_reg_write(wm, AC97_GPIO_WAKEUP, wm->gpio[3]);
++       wm97xx_reg_write(wm, AC97_GPIO_STATUS, wm->gpio[4]);
++       wm97xx_reg_write(wm, AC97_MISC_AFE, wm->gpio[5]);
++
++       return 0;
++}
++
++#else
++#define wm97xx_resume          NULL
++#endif
++
++int wm97xx_register_mach_ops(struct wm97xx *wm, struct wm97xx_mach_ops *mach_ops)
++{
++       mutex_lock(&wm->codec_mutex);
++    if(wm->mach_ops) {
++       mutex_unlock(&wm->codec_mutex);
++       return -EINVAL;
++    }
++    wm->mach_ops = mach_ops;
++    mutex_unlock(&wm->codec_mutex);
++    return 0;
++}
++
++void wm97xx_unregister_mach_ops(struct wm97xx *wm)
++{
++       mutex_lock(&wm->codec_mutex);
++    wm->mach_ops = NULL;
++    mutex_unlock(&wm->codec_mutex);
++}
++
++static struct device_driver wm97xx_driver = {
++       .name =         "ac97",
++       .bus =          &ac97_bus_type,
++       .owner =        THIS_MODULE,
++       .probe =        wm97xx_probe,
++       .remove =       wm97xx_remove,
++       .resume =       wm97xx_resume,
++};
++
++static int __init wm97xx_init(void)
++{
++       int ret;
++
++       info("version %s liam.girdwood@wolfsonmicro.com", WM_CORE_VERSION);
++    if((ret = bus_register(&wm97xx_bus_type)) < 0)
++       return ret;
++       return driver_register(&wm97xx_driver);
++}
++
++static void __exit wm97xx_exit(void)
++{
++       driver_unregister(&wm97xx_driver);
++    bus_unregister(&wm97xx_bus_type);
++}
++
++EXPORT_SYMBOL_GPL(wm97xx_get_gpio);
++EXPORT_SYMBOL_GPL(wm97xx_set_gpio);
++EXPORT_SYMBOL_GPL(wm97xx_config_gpio);
++EXPORT_SYMBOL_GPL(wm97xx_read_aux_adc);
++EXPORT_SYMBOL_GPL(wm97xx_reg_read);
++EXPORT_SYMBOL_GPL(wm97xx_reg_write);
++EXPORT_SYMBOL_GPL(wm97xx_bus_type);
++EXPORT_SYMBOL_GPL(wm97xx_register_mach_ops);
++EXPORT_SYMBOL_GPL(wm97xx_unregister_mach_ops);
++
++module_init(wm97xx_init);
++module_exit(wm97xx_exit);
++
++/* Module information */
++MODULE_AUTHOR("Liam Girdwood, liam.girdwood@wolfsonmicro.com, www.wolfsonmicro.com");
++MODULE_DESCRIPTION("WM97xx Core - Touch Screen / AUX ADC / GPIO Driver");
++MODULE_LICENSE("GPL");
+Index: linux-2.6.17/include/linux/wm97xx.h
+===================================================================
+--- /dev/null   1970-01-01 00:00:00.000000000 +0000
++++ linux-2.6.17/include/linux/wm97xx.h 2006-09-19 20:36:47.973052250 +0200
+@@ -0,0 +1,291 @@
++
++/*
++ * Register bits and API for Wolfson WM97xx series of codecs
++ */
++
++#ifndef _LINUX_WM97XX_H
++#define _LINUX_WM97XX_H
++
++#include <sound/driver.h>
++#include <sound/core.h>
++#include <sound/pcm.h>
++#include <sound/ac97_codec.h>
++#include <sound/initval.h>
++#include <linux/types.h>
++#include <linux/list.h>
++#include <linux/input.h>       /* Input device layer */
++
++/*
++ * WM97xx AC97 Touchscreen registers
++ */
++#define AC97_WM97XX_DIGITISER1         0x76
++#define AC97_WM97XX_DIGITISER2         0x78
++#define AC97_WM97XX_DIGITISER_RD       0x7a
++#define AC97_WM9713_DIG1                       0x74
++#define AC97_WM9713_DIG2                       AC97_WM97XX_DIGITISER1
++#define AC97_WM9713_DIG3                       AC97_WM97XX_DIGITISER2
++
++/*
++ * WM97xx register bits
++ */
++#define WM97XX_POLL                    0x8000  /* initiate a polling measurement */
++#define WM97XX_ADCSEL_X                0x1000  /* x coord measurement */
++#define WM97XX_ADCSEL_Y                0x2000  /* y coord measurement */
++#define WM97XX_ADCSEL_PRES     0x3000  /* pressure measurement */
++#define WM97XX_ADCSEL_MASK     0x7000
++#define WM97XX_COO                     0x0800  /* enable coordinate mode */
++#define WM97XX_CTC                     0x0400  /* enable continuous mode */
++#define WM97XX_CM_RATE_93      0x0000  /* 93.75Hz continuous rate */
++#define WM97XX_CM_RATE_187     0x0100  /* 187.5Hz continuous rate */
++#define WM97XX_CM_RATE_375     0x0200  /* 375Hz continuous rate */
++#define WM97XX_CM_RATE_750     0x0300  /* 750Hz continuous rate */
++#define WM97XX_CM_RATE_8K      0x00f0  /* 8kHz continuous rate */
++#define WM97XX_CM_RATE_12K     0x01f0  /* 12kHz continuous rate */
++#define WM97XX_CM_RATE_24K     0x02f0  /* 24kHz continuous rate */
++#define WM97XX_CM_RATE_48K     0x03f0  /* 48kHz continuous rate */
++#define WM97XX_CM_RATE_MASK    0x03f0
++#define WM97XX_RATE(i)         (((i & 3) << 8) | ((i & 4) ? 0xf0 : 0))
++#define WM97XX_DELAY(i)                ((i << 4) & 0x00f0)     /* sample delay times */
++#define WM97XX_DELAY_MASK      0x00f0
++#define WM97XX_SLEN                    0x0008  /* slot read back enable */
++#define WM97XX_SLT(i)          ((i - 5) & 0x7) /* touchpanel slot selection (5-11) */
++#define WM97XX_SLT_MASK                0x0007
++#define WM97XX_PRP_DETW                0x4000  /* pen detect on, digitiser off, wake up */
++#define WM97XX_PRP_DET         0x8000  /* pen detect on, digitiser off, no wake up */
++#define WM97XX_PRP_DET_DIG     0xc000  /* pen detect on, digitiser on */
++#define WM97XX_RPR                     0x2000  /* wake up on pen down */
++#define WM97XX_PEN_DOWN                0x8000  /* pen is down */
++#define WM97XX_ADCSRC_MASK     0x7000  /* ADC source mask */
++
++#define WM97XX_AUX_ID1         0x8001
++#define WM97XX_AUX_ID2         0x8002
++#define WM97XX_AUX_ID3         0x8003
++#define WM97XX_AUX_ID4         0x8004
++
++
++/* WM9712 Bits */
++#define WM9712_45W                     0x1000  /* set for 5-wire touchscreen */
++#define WM9712_PDEN                    0x0800  /* measure only when pen down */
++#define WM9712_WAIT                    0x0200  /* wait until adc is read before next sample */
++#define WM9712_PIL                     0x0100  /* current used for pressure measurement. set 400uA else 200uA */
++#define WM9712_MASK_HI         0x0040  /* hi on mask pin (47) stops conversions */
++#define WM9712_MASK_EDGE       0x0080  /* rising/falling edge on pin delays sample */
++#define        WM9712_MASK_SYNC        0x00c0  /* rising/falling edge on mask initiates sample */
++#define WM9712_RPU(i)          (i&0x3f)        /* internal pull up on pen detect (64k / rpu) */
++#define WM9712_PD(i)           (0x1 << i)      /* power management */
++
++/* WM9712 Registers */
++#define AC97_WM9712_POWER      0x24
++#define AC97_WM9712_REV                0x58
++
++/* WM9705 Bits */
++#define WM9705_PDEN                    0x1000  /* measure only when pen is down */
++#define WM9705_PINV                    0x0800  /* inverts sense of pen down output */
++#define WM9705_BSEN                    0x0400  /* BUSY flag enable, pin47 is 1 when busy */
++#define WM9705_BINV                    0x0200  /* invert BUSY (pin47) output */
++#define WM9705_WAIT                    0x0100  /* wait until adc is read before next sample */
++#define WM9705_PIL                     0x0080  /* current used for pressure measurement. set 400uA else 200uA */
++#define WM9705_PHIZ                    0x0040  /* set PHONE and PCBEEP inputs to high impedance */
++#define WM9705_MASK_HI         0x0010  /* hi on mask stops conversions */
++#define WM9705_MASK_EDGE       0x0020  /* rising/falling edge on pin delays sample */
++#define        WM9705_MASK_SYNC        0x0030  /* rising/falling edge on mask initiates sample */
++#define WM9705_PDD(i)          (i & 0x000f)    /* pen detect comparator threshold */
++
++
++/* WM9713 Bits */
++#define WM9713_PDPOL           0x0400  /* Pen down polarity */
++#define WM9713_POLL                    0x0200  /* initiate a polling measurement */
++#define WM9713_CTC                     0x0100  /* enable continuous mode */
++#define WM9713_ADCSEL_X                0x0002  /* X measurement */
++#define WM9713_ADCSEL_Y                0x0004  /* Y measurement */
++#define WM9713_ADCSEL_PRES     0x0008  /* Pressure measurement */
++#define WM9713_COO                     0x0001  /* enable coordinate mode */
++#define WM9713_PDEN                    0x0800  /* measure only when pen down */
++#define WM9713_ADCSEL_MASK     0x00fe  /* ADC selection mask */
++#define WM9713_WAIT                    0x0200  /* coordinate wait */
++
++/* AUX ADC ID's */
++#define TS_COMP1                       0x0
++#define TS_COMP2                       0x1
++#define TS_BMON                                0x2
++#define TS_WIPER                       0x3
++
++/* ID numbers */
++#define WM97XX_ID1                     0x574d
++#define WM9712_ID2                     0x4c12
++#define WM9705_ID2                     0x4c05
++#define WM9713_ID2                     0x4c13
++
++/* Codec GPIO's */
++#define WM97XX_MAX_GPIO                16
++#define WM97XX_GPIO_1          (1 << 1)
++#define WM97XX_GPIO_2          (1 << 2)
++#define WM97XX_GPIO_3          (1 << 3)
++#define WM97XX_GPIO_4          (1 << 4)
++#define WM97XX_GPIO_5          (1 << 5)
++#define WM97XX_GPIO_6          (1 << 6)
++#define WM97XX_GPIO_7          (1 << 7)
++#define WM97XX_GPIO_8          (1 << 8)
++#define WM97XX_GPIO_9          (1 << 9)
++#define WM97XX_GPIO_10         (1 << 10)
++#define WM97XX_GPIO_11         (1 << 11)
++#define WM97XX_GPIO_12         (1 << 12)
++#define WM97XX_GPIO_13         (1 << 13)
++#define WM97XX_GPIO_14         (1 << 14)
++#define WM97XX_GPIO_15         (1 << 15)
++
++
++#define AC97_LINK_FRAME                21      /* time in uS for AC97 link frame */
++
++
++/*---------------- Return codes from sample reading functions ---------------*/
++
++/* More data is available; call the sample gathering function again */
++#define RC_AGAIN                       0x00000001
++/* The returned sample is valid */
++#define RC_VALID                       0x00000002
++/* The pen is up (the first RC_VALID without RC_PENUP means pen is down) */
++#define RC_PENUP                       0x00000004
++/* The pen is down (RC_VALID implies RC_PENDOWN, but sometimes it is helpful
++   to tell the handler that the pen is down but we don't know yet his coords,
++   so the handler should not sleep or wait for pendown irq) */
++#define RC_PENDOWN                     0x00000008
++
++/* The wm97xx driver provides a private API for writing platform-specific
++ * drivers.
++ */
++
++/* The structure used to return arch specific sampled data into */
++struct wm97xx_data {
++    int x;
++    int y;
++    int p;
++};
++
++/* Codec GPIO status
++ */
++typedef enum {
++    WM97XX_GPIO_HIGH,
++    WM97XX_GPIO_LOW
++} wm97xx_gpio_status_t;
++
++/* Codec GPIO direction
++ */
++typedef enum {
++    WM97XX_GPIO_IN,
++    WM97XX_GPIO_OUT
++} wm97xx_gpio_dir_t;
++
++/* Codec GPIO polarity
++ */
++typedef enum {
++    WM97XX_GPIO_POL_HIGH,
++    WM97XX_GPIO_POL_LOW
++} wm97xx_gpio_pol_t;
++
++/* Codec GPIO sticky
++ */
++typedef enum {
++    WM97XX_GPIO_STICKY,
++    WM97XX_GPIO_NOTSTICKY
++} wm97xx_gpio_sticky_t;
++
++/* Codec GPIO wake
++ */
++typedef enum {
++    WM97XX_GPIO_WAKE,
++    WM97XX_GPIO_NOWAKE
++} wm97xx_gpio_wake_t;
++
++
++/*
++ * Digitiser ioctl commands
++ */
++#define WM97XX_DIG_START       0x1
++#define WM97XX_DIG_STOP                0x2
++#define WM97XX_PHY_INIT                0x3
++#define WM97XX_AUX_PREPARE     0x4
++#define WM97XX_DIG_RESTORE     0x5
++
++struct wm97xx;
++extern struct wm97xx_codec_drv wm97xx_codec;
++
++/*
++ * Codec driver interface - allows mapping to WM9705/12/13 and newer codecs
++ */
++struct wm97xx_codec_drv {
++       u16 id;
++    char *name;
++       int (*poll_sample) (struct wm97xx *, int adcsel, int *sample);  /* read 1 sample */
++       int (*poll_touch) (struct wm97xx *, struct wm97xx_data *);      /* read X,Y,[P] in poll */
++       int (*digitiser_ioctl) (struct wm97xx *, int cmd);
++       int (*acc_enable) (struct wm97xx *, int enable);
++};
++
++
++/* Machine specific and accelerated touch operations */
++struct wm97xx_mach_ops {
++
++       /* accelerated touch readback - coords are transmited on AC97 link */
++       int acc_enabled;
++    void (*acc_pen_up) (struct wm97xx *);
++    int (*acc_pen_down) (struct wm97xx *);
++    int (*acc_startup) (struct wm97xx *);
++    void (*acc_shutdown) (struct wm97xx *);
++
++    /* pre and post sample - can be used to minimise any analog noise */
++    void (*pre_sample) (int);  /* function to run before sampling */
++    void (*post_sample) (int);  /* function to run after sampling */
++};
++
++struct wm97xx {
++       u16 dig[3], id, gpio[6], misc;  /* Cached codec registers */
++       u16 dig_save[3];                /* saved during aux reading */
++       struct wm97xx_codec_drv *codec; /* attached codec driver*/
++       struct input_dev* input_dev;    /* touchscreen input device */
++       ac97_t *ac97;                   /* ALSA codec access */
++       struct device *dev;             /* ALSA device */
++    struct device *battery_dev;
++    struct device *touch_dev;
++    struct wm97xx_mach_ops *mach_ops;
++    struct mutex codec_mutex;
++       struct completion ts_init;
++       struct completion ts_exit;
++       struct task_struct *ts_task;
++       unsigned int pen_irq;   /* Pen IRQ number in use */
++       wait_queue_head_t pen_irq_wait; /* Pen IRQ wait queue */
++       struct workqueue_struct *pen_irq_workq;
++       struct work_struct pen_event_work;
++       u16 acc_slot; /* AC97 slot used for acc touch data */
++       u16 acc_rate; /* acc touch data rate */
++       unsigned int ts_use_count;
++       unsigned pen_is_down:1; /* Pen is down */
++       unsigned aux_waiting:1; /* aux measurement waiting */
++       unsigned pen_probably_down:1;   /* used in polling mode */
++};
++
++/* Codec GPIO access (not supported on WM9705)
++ * This can be used to set/get codec GPIO and Virtual GPIO status.
++ */
++wm97xx_gpio_status_t wm97xx_get_gpio(struct wm97xx *wm, u32 gpio);
++void wm97xx_set_gpio(struct wm97xx *wm, u32 gpio,
++                         wm97xx_gpio_status_t status);
++void wm97xx_config_gpio(struct wm97xx *wm, u32 gpio,
++                                    wm97xx_gpio_dir_t dir,
++                                    wm97xx_gpio_pol_t pol,
++                                    wm97xx_gpio_sticky_t sticky,
++                                    wm97xx_gpio_wake_t wake);
++
++/* codec AC97 IO access */
++int wm97xx_reg_read(struct wm97xx *wm, u16 reg);
++void wm97xx_reg_write(struct wm97xx *wm, u16 reg, u16 val);
++
++/* aux adc readback */
++int wm97xx_read_aux_adc(struct wm97xx *wm, u16 adcsel);
++
++/* machine ops */
++int wm97xx_register_mach_ops(struct wm97xx *, struct wm97xx_mach_ops *);
++void wm97xx_unregister_mach_ops(struct wm97xx *);
++
++extern struct bus_type wm97xx_bus_type;
++#endif
diff --git a/meta/packages/linux/linux-rp_2.6.23+2.6.24-rc8.bb b/meta/packages/linux/linux-rp_2.6.23+2.6.24-rc8.bb
index 353e8c1fc3..efffb6e404 100644
--- a/meta/packages/linux/linux-rp_2.6.23+2.6.24-rc8.bb
+++ b/meta/packages/linux/linux-rp_2.6.23+2.6.24-rc8.bb
@@ -1,6 +1,6 @@
 require linux-rp.inc
 
-PR = "r2"
+PR = "r4"
 
 DEFAULT_PREFERENCE = "-1"
 
@@ -17,43 +17,44 @@ DEFAULT_PREFERENCE = "-1"
 # Hacks should clearly named and at the bottom
 SRC_URI = "${KERNELORG_MIRROR}pub/linux/kernel/v2.6/linux-2.6.23.tar.bz2 \
            ${KERNELORG_MIRROR}pub/linux/kernel/v2.6/testing/patch-2.6.24-rc8.bz2;patch=1 \
-           ${RPSRC}/lzo_crypto-r2.patch;patch=1 \
+           ${RPSRC}/export_atags-r2.patch;patch=1;status=pending \
+           ${RPSRC}/lzo_crypto-r2.patch;patch=1;status=pending \
+           ${RPSRC}/corgi_rearrange_lcd-r0.patch;patch=1;status=pending \
            ${RPSRC}/lzo_jffs2_sysfs-r1.patch;patch=1 \
-           file://hx2750_base-r31.patch;patch=1 \
+           ${RPSRC}/hx2750_base-r31.patch;patch=1 \
            ${RPSRC}/hx2750_bl-r9.patch;patch=1 \
            ${RPSRC}/hx2750_pcmcia-r3.patch;patch=1 \
            ${RPSRC}/pxa_keys-r8.patch;patch=1 \
-#          ${RPSRC}/tsc2101-r16.patch;patch=1 \
+           ${RPSRC}/tsc2101-r17.patch;patch=1 \
            ${RPSRC}/hx2750_test1-r7.patch;patch=1 \
            ${RPSRC}/input_power-r10.patch;patch=1 \
-           ${RPSRC}/input_power_fix-r0.patch;patch=1 \
            ${RPSRC}/pxa25x_cpufreq-r2.patch;patch=1 \
            ${RPSRC}/sharpsl_pm_fixes1-r0.patch;patch=1 \
            ${RPSRC}/pm_changes-r1.patch;patch=1 \
            ${RPSRC}/usb_add_epalloc-r4.patch;patch=1 \
-           ${RPSRC}/usb_pxa27x_udc-r7.patch;patch=1 \
+           ${RPSRC}/usb_pxa27x_udc-r8.patch;patch=1 \
            ${RPSRC}/locomo_kbd_tweak-r1.patch;patch=1 \
-           ${RPSRC}/poodle_pm-r5.patch;patch=1 \
-           file://pxa27x_overlay-r8.patch;patch=1 \
-           ${RPSRC}/w100_extaccel-r1.patch;patch=1 \
+           ${RPSRC}/pxa27x_overlay-r8.patch;patch=1 \
+           ${RPSRC}/w100_extaccel-r2.patch;patch=1 \
            ${RPSRC}/w100_extmem-r1.patch;patch=1 \
-           ${RPSRC}/export_atags-r1.patch;patch=1 \
-           file://w100fb-unused-var.patch;patch=1 \
-           file://hostap-monitor-mode.patch;patch=1 \
-           file://serial-add-support-for-non-standard-xtals-to-16c950-driver.patch;patch=1 \
+           ${RPSRC}/poodle_pm-r5.patch;patch=1 \
+           ${RPSRC}/poodle_lcd_hack-r0.patch;patch=1 \
+           ${RPSRC}/poodle_asoc_fix-r1.patch;patch=1 \
+           file://squashfs3.3.patch;patch=1;status=external \
            ${RPSRC}/logo_oh-r1.patch.bz2;patch=1;status=unmergable \
            ${RPSRC}/pxa-linking-bug.patch;patch=1;status=unmergable \
+           file://hostap-monitor-mode.patch;patch=1;status=unmergable \
+           file://serial-add-support-for-non-standard-xtals-to-16c950-driver.patch;patch=1;status=unmergable \
            ${RPSRC}/mmcsd_large_cards-r1.patch;patch=1;status=hack \
-           file://mmcsd_no_scr_check-r2.patch;patch=1 \
+           ${RPSRC}/mmcsd_no_scr_check-r2.patch;patch=1;status=hack \
            ${RPSRC}/integrator_rgb-r1.patch;patch=1;status=hack \
            ${RPSRC}/pxa_cf_initorder_hack-r1.patch;patch=1;status=hack \
-           ${RPSRC}/corgi_rearrange_lcd-r0.patch;patch=1 \
            file://pxa-serial-hack.patch;patch=1;status=hack \
            file://connectplus-remove-ide-HACK.patch;patch=1;status=hack \
-#          file://squashfs3.2-2.6.20-r0.patch;patch=1;status=external \
+           file://connectplus-prevent-oops-HACK.patch;patch=1;status=hack \
 #          file://htcuni.patch;patch=1 \
            file://binutils-buildid-arm.patch;patch=1 \
-           file://versatile-armv6.patch;patch=1 \
+           file://versatile-armv6.patch;patch=1 \
            file://defconfig-c7x0 \
            file://defconfig-hx2000 \
            file://defconfig-collie \
@@ -84,36 +85,51 @@ SRC_URI = "${KERNELORG_MIRROR}pub/linux/kernel/v2.6/linux-2.6.23.tar.bz2 \
 # These patches are extracted from Pavel Machek's git tree
 # (diff against vanilla kernel)
 SRC_URI_append_collie = "\
-           ${DOSRC}/collie/mtd-sharp-flash-hack-r0.patch;patch=1 \
-           ${DOSRC}/collie/collie-r0.patch;patch=1 \
-           ${DOSRC}/collie/locomolcd-backlight-r0.patch;patch=1 \
-           ${DOSRC}/collie/ucb1x00-touch-audio-r0.patch;patch=1 \
-           file://collie-mcp-r1.patch;patch=1 \
-           ${DOSRC}/collie/sa1100-udc-r0.patch;patch=1 \
-#          ${DOSRC}/collie/collie-pm-r1.patch;patch=1 \
+        ${TKSRC}/mtd-sharp-flash-hack-r3.patch;patch=1 \
+        ${TKSRC}/mcp-sa11x0-r0.patch;patch=1 \
+        ${TKSRC}/locomo-r0.patch;patch=1 \
+#       ${TKSRC}/locomo_spi-4.patch;patch=1 \
+        ${TKSRC}/collie-kexec.patch;patch=1 \
+        ${TKSRC}/sharpsl_pm-3.patch;patch=1 \
+        ${TKSRC}/collie_pm-2.patch;patch=1 \
+        ${TKSRC}/locomokeyb_suspendkey-2.patch;patch=1 \
+        ${TKSRC}/ucb1x00_suspend.patch;patch=1 \
+        ${TKSRC}/collie-ts.patch;patch=1 \
+        ${TKSRC}/pcmcia_suspend.patch;patch=1 \
+"
+
+SRC_URI_append_poodle = "\
+           ${RPSRC}/poodle_serial_vcc-r0.patch;patch=1 \
 "
 
 SRC_URI_append_tosa = "\
-           ${CHSRC}/usb-ohci-hooks-r1.patch;patch=1 \
            ${CHSRC}/tmio-core-r4.patch;patch=1 \
            file://tmio-tc6393-r8.patch;patch=1 \
-           file://tmio-nand-r7.patch;patch=1 \
-           file://tmio-ohci-r6.patch;patch=1 \
+           file://tmio-nand-r8.patch;patch=1 \
            ${CHSRC}/tmio-fb-r6.patch;patch=1 \
-           file://tosa-keyboard-r18.patch;patch=1 \
+           file://tmio-fb-r6-fix-r0.patch;patch=1 \
+           file://tosa-keyboard-r19.patch;patch=1 \
            ${DOSRC}/tosa-pxaac97-r6.patch;patch=1 \
+           file://tosa-pxaac97-r6-fix-r0.patch;patch=1 \
            ${DOSRC}/tosa-tmio-r6.patch;patch=1 \
-           ${DOSRC}/tosa-power-r17.patch;patch=1 \
+           file://tosa-power-r18.patch;patch=1 \
+           file://tosa-power-r18-fix-r0.patch;patch=1 \
            file://tosa-tmio-lcd-r10.patch;patch=1 \
-           ${DOSRC}/tosa-bluetooth-r8.patch;patch=1 \
-           ${DOSRC}/wm97xx-lg7-r0.patch;patch=1 \
+           file://tosa-tmio-lcd-r10-fix-r0.patch;patch=1 \
+           file://tosa-bluetooth-r8.patch;patch=1 \
+           file://wm97xx-lg13-r0.patch;patch=1 \
+           file://wm97xx-lg13-r0-fix-r0.patch;patch=1 \
            file://wm9712-suspend-cold-res-r2.patch;patch=1 \
            file://sharpsl-pm-postresume-r1.patch;patch=1 \
-           ${DOSRC}/wm97xx-dig-restore-r0.patch;patch=1 \
-           ${DOSRC}/wm97xx-miscdevs-resume-r0.patch;patch=1 \
            file://wm9712-reset-loop-r2.patch;patch=1 \
            file://tosa-lcdnoise-r1.patch;patch=1 \
-           file://wm97xx-lcdnoise-r0.patch;patch=1 "
+           file://tosa-lcdnoise-r1-fix-r0.patch;patch=1 \
+           file://arm-dma-coherent.patch;patch=1 \
+           file://usb-ohci-hooks-r3.patch;patch=1 \
+           file://tmio-ohci-r9.patch;patch=1 \
+           file://pxa2xx_udc_support_inverse_vbus.patch;patch=1 \
+           file://tosa_udc_use_gpio_vbus.patch;patch=1 \
+           "
 #          ${DOSRC}/tosa-asoc-r1.patch;patch=1 "
 
 SRC_URI_append_htcuniversal ="\
diff --git a/meta/packages/linux/linux-rp_2.6.23.bb b/meta/packages/linux/linux-rp_2.6.23.bb
index 2de4ad0cf2..a8c5f79f67 100644
--- a/meta/packages/linux/linux-rp_2.6.23.bb
+++ b/meta/packages/linux/linux-rp_2.6.23.bb
@@ -1,6 +1,6 @@
 require linux-rp.inc
 
-PR = "r25"
+PR = "r26"
 
 # Handy URLs
 # git://git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux-2.6.git;protocol=git;tag=ef7d1b244fa6c94fb76d5f787b8629df64ea4046
@@ -14,10 +14,15 @@ PR = "r25"
 # Patches submitted upstream are towards top of this list 
 # Hacks should clearly named and at the bottom
 SRC_URI = "${KERNELORG_MIRROR}pub/linux/kernel/v2.6/linux-2.6.23.tar.bz2 \
-           file://hrw-add-wcf11-to-hostap.patch;patch=1;status=pending \
-           ${RPSRC}/lzo_jffs2-r3.patch;patch=1 \
-           ${RPSRC}/lzo_crypto-r2.patch;patch=1 \
-           ${RPSRC}/lzo_jffs2_lzomode-r1.patch;patch=1 \
+           ${RPSRC}/pxa25x_suspend_fixes-r0.patch;patch=1;status=merged \
+           ${RPSRC}/lzo_jffs2-r3.patch;patch=1;status=merged \
+           ${RPSRC}/lzo_jffs2_lzomode-r1.patch;patch=1;status=merged \
+           ${RPSRC}/spitzkbd_fix-r0.patch;patch=1;status=merged \
+           file://uvesafb-0.1-rc3-2.6.22.patch;patch=1;status=merged \
+           ${RPSRC}/locomo_led_fix-r0.patch;patch=1;status=merged \
+           file://hrw-add-wcf11-to-hostap.patch;patch=1;status=merged \
+           ${RPSRC}/export_atags-r0a.patch;patch=1;status=pending \
+           ${RPSRC}/lzo_crypto-r2.patch;patch=1;status=pending \
            ${RPSRC}/lzo_jffs2_sysfs-r1.patch;patch=1 \
            ${RPSRC}/hx2750_base-r29.patch;patch=1 \
            ${RPSRC}/hx2750_bl-r9.patch;patch=1 \
@@ -32,33 +37,27 @@ SRC_URI = "${KERNELORG_MIRROR}pub/linux/kernel/v2.6/linux-2.6.23.tar.bz2 \
            ${RPSRC}/usb_add_epalloc-r3.patch;patch=1 \
            ${RPSRC}/usb_pxa27x_udc-r6.patch;patch=1 \
            ${RPSRC}/locomo_kbd_tweak-r1.patch;patch=1 \
-           ${RPSRC}/poodle_pm-r4.patch;patch=1 \
            ${RPSRC}/pxa27x_overlay-r6.patch;patch=1 \
-           ${RPSRC}/w100_extaccel-r1.patch;patch=1 \
+           ${RPSRC}/w100_extaccel-r2.patch;patch=1 \
            ${RPSRC}/w100_extmem-r1.patch;patch=1 \
-           ${RPSRC}/spitzkbd_fix-r0.patch;patch=1 \
-           ${RPSRC}/export_atags-r0.patch;patch=1 \
-           ${RPSRC}/pxa25x_suspend_fixes-r0.patch;patch=1 \
+           ${RPSRC}/poodle_pm-r4.patch;patch=1 \
            ${RPSRC}/poodle_lcd_hack-r0.patch;patch=1 \
            ${RPSRC}/poodle_asoc_fix-r1.patch;patch=1 \
-           ${RPSRC}/locomo_led_fix-r0.patch;patch=1 \
-           file://w100fb-unused-var.patch;patch=1 \
-           file://hostap-monitor-mode.patch;patch=1 \
-           file://serial-add-support-for-non-standard-xtals-to-16c950-driver.patch;patch=1 \
+           file://squashfs3.0-2.6.15.patch;patch=1;status=external \
            ${RPSRC}/logo_oh-r1.patch.bz2;patch=1;status=unmergable \
-           ${RPSRC}/logo_oz-r2.patch.bz2;patch=1;status=unmergable \
            ${RPSRC}/pxa-linking-bug.patch;patch=1;status=unmergable \
+           file://hostap-monitor-mode.patch;patch=1;status=unmergable \
+           file://serial-add-support-for-non-standard-xtals-to-16c950-driver.patch;patch=1;status=unmergable \
            ${RPSRC}/mmcsd_large_cards-r1.patch;patch=1;status=hack \
-           file://mmcsd_no_scr_check-r2.patch;patch=1 \
+           ${RPSRC}/mmcsd_no_scr_check-r2.patch;patch=1;status=hack \
            ${RPSRC}/integrator_rgb-r1.patch;patch=1;status=hack \
            ${RPSRC}/pxa_cf_initorder_hack-r1.patch;patch=1;status=hack \
            file://pxa-serial-hack.patch;patch=1;status=hack \
            file://connectplus-remove-ide-HACK.patch;patch=1;status=hack \
            file://connectplus-prevent-oops-HACK.patch;patch=1;status=hack \
-           file://squashfs3.0-2.6.15.patch;patch=1;status=external \
-           file://uvesafb-0.1-rc3-2.6.22.patch;patch=1;status=external \
            file://htcuni.patch;patch=1 \
            file://binutils-buildid-arm.patch;patch=1 \
+           file://versatile-armv6.patch;patch=1 \
            file://defconfig-c7x0 \
            file://defconfig-hx2000 \
            file://defconfig-collie \