}
 
 struct da8xx_fb_par {
-       wait_queue_head_t da8xx_wq;
        resource_size_t p_palette_base;
        unsigned char *v_palette_base;
        struct clk *lcdc_clk;
        int             vbp;            /* Vertical back porch */
        int             vsw;            /* Vertical Sync Pulse Width */
        int             pxl_clk;        /* Pixel clock */
+       unsigned char   invert_pxl_clk; /* Invert Pixel clock */
 };
 
 static struct da8xx_panel known_lcd_panels[] = {
                .vbp = 2,
                .vsw = 0,
                .pxl_clk = 0x10,
+               .invert_pxl_clk = 1,
        },
        /* Sharp LK043T1DG01 */
        [1] = {
                .vbp = 2,
                .vsw = 10,
                .pxl_clk = 0x12,
+               .invert_pxl_clk = 0,
        },
 };
 
 /* Disable the Raster Engine of the LCD Controller */
-static int lcd_disable_raster(struct da8xx_fb_par *par)
+static void lcd_disable_raster(struct da8xx_fb_par *par)
 {
-       int ret = 0;
        u32 reg;
 
        reg = lcdc_read(LCD_RASTER_CTRL_REG);
-       if (reg & LCD_RASTER_ENABLE) {
+       if (reg & LCD_RASTER_ENABLE)
                lcdc_write(reg & ~LCD_RASTER_ENABLE, LCD_RASTER_CTRL_REG);
-               ret = wait_event_interruptible_timeout(par->da8xx_wq,
-                                               !lcdc_read(LCD_STAT_REG) &
-                                               LCD_END_OF_FRAME0, WSI_TIMEOUT);
-       }
-
-       if (ret < 0)
-               return ret;
-       if (ret == 0)
-               return -ETIMEDOUT;
-
-       return 0;
 }
 
 static void lcd_blit(int load_mode, struct da8xx_fb_par *par)
        default:
                return -EINVAL;
        }
-       lcdc_write(reg | LCD_END_OF_FRAME_INT_ENA, LCD_DMA_CTRL_REG);
+       lcdc_write(reg, LCD_DMA_CTRL_REG);
 
        return 0;
 }
        else
                reg &= ~LCD_SYNC_EDGE;
 
-       if (cfg->invert_pxl_clock)
-               reg |= LCD_INVERT_PIXEL_CLOCK;
-       else
-               reg &= ~LCD_INVERT_PIXEL_CLOCK;
-
        if (cfg->invert_line_clock)
                reg |= LCD_INVERT_LINE_CLOCK;
        else
        return 0;
 }
 
-static int lcd_reset(struct da8xx_fb_par *par)
+static void lcd_reset(struct da8xx_fb_par *par)
 {
-       int ret = 0;
-
        /* Disable the Raster if previously Enabled */
        if (lcdc_read(LCD_RASTER_CTRL_REG) & LCD_RASTER_ENABLE)
-               ret = lcd_disable_raster(par);
+               lcd_disable_raster(par);
 
        /* DMA has to be disabled */
        lcdc_write(0, LCD_DMA_CTRL_REG);
        lcdc_write(0, LCD_RASTER_CTRL_REG);
-
-       return ret;
 }
 
 static int lcd_init(struct da8xx_fb_par *par, const struct lcd_ctrl_config *cfg,
        u32 bpp;
        int ret = 0;
 
-       ret = lcd_reset(par);
-       if (ret != 0)
-               return ret;
+       lcd_reset(par);
 
        /* Configure the LCD clock divisor. */
        lcdc_write(LCD_CLK_DIVISOR(panel->pxl_clk) |
                        (LCD_RASTER_MODE & 0x1), LCD_CTRL_REG);
 
+       if (panel->invert_pxl_clk)
+               lcdc_write((lcdc_read(LCD_RASTER_TIMING_2_REG) |
+                       LCD_INVERT_PIXEL_CLOCK), LCD_RASTER_TIMING_2_REG);
+       else
+               lcdc_write((lcdc_read(LCD_RASTER_TIMING_2_REG) &
+                       ~LCD_INVERT_PIXEL_CLOCK), LCD_RASTER_TIMING_2_REG);
+
        /* Configure the DMA burst size. */
        ret = lcd_cfg_dma(cfg->dma_burst_sz);
        if (ret < 0)
 static irqreturn_t lcdc_irq_handler(int irq, void *arg)
 {
        u32 stat = lcdc_read(LCD_STAT_REG);
-       struct da8xx_fb_par *par = arg;
        u32 reg;
 
        if ((stat & LCD_SYNC_LOST) && (stat & LCD_FIFO_UNDERFLOW)) {
        } else
                lcdc_write(stat, LCD_STAT_REG);
 
-       wake_up_interruptible(&par->da8xx_wq);
        return IRQ_HANDLED;
 }
 
 static int __devexit fb_remove(struct platform_device *dev)
 {
        struct fb_info *info = dev_get_drvdata(&dev->dev);
-       int ret = 0;
 
        if (info) {
                struct da8xx_fb_par *par = info->par;
 
                if (lcdc_read(LCD_RASTER_CTRL_REG) & LCD_RASTER_ENABLE)
-                       ret = lcd_disable_raster(par);
+                       lcd_disable_raster(par);
                lcdc_write(0, LCD_RASTER_CTRL_REG);
 
                /* disable DMA  */
                release_mem_region(lcdc_regs->start, resource_size(lcdc_regs));
 
        }
-       return ret;
+       return 0;
 }
 
 static int fb_ioctl(struct fb_info *info, unsigned int cmd,
        case FBIPUT_BRIGHTNESS:
        case FBIGET_COLOR:
        case FBIPUT_COLOR:
-               return -EINVAL;
+               return -ENOTTY;
        case FBIPUT_HSYNC:
                if (copy_from_user(&sync_arg, (char *)arg,
                                sizeof(struct lcd_sync_arg)))
-                       return -EINVAL;
+                       return -EFAULT;
                lcd_cfg_horizontal_sync(sync_arg.back_porch,
                                        sync_arg.pulse_width,
                                        sync_arg.front_porch);
        case FBIPUT_VSYNC:
                if (copy_from_user(&sync_arg, (char *)arg,
                                sizeof(struct lcd_sync_arg)))
-                       return -EINVAL;
+                       return -EFAULT;
                lcd_cfg_vertical_sync(sync_arg.back_porch,
                                        sync_arg.pulse_width,
                                        sync_arg.front_porch);
 
        par->lcdc_clk = fb_clk;
 
-       init_waitqueue_head(&par->da8xx_wq);
-
        par->irq = platform_get_irq(device, 0);
        if (par->irq < 0) {
                ret = -ENOENT;