#include <asm/arch/lcdc.h>
 #include <asm/io.h>
 
-#include "../videomodes.h"
-
-static int lcdc_get_clk_delay(const struct ctfb_res_modes *mode, int tcon)
+static int lcdc_get_clk_delay(const struct display_timing *mode, int tcon)
 {
        int delay;
 
-       delay = mode->lower_margin + mode->vsync_len +
-               mode->upper_margin;
-       if (mode->vmode == FB_VMODE_INTERLACED)
+       delay = mode->vfront_porch.typ + mode->vsync_len.typ +
+               mode->vback_porch.typ;
+       if (mode->flags & DISPLAY_FLAGS_INTERLACED)
                delay /= 2;
        if (tcon == 1)
                delay -= 2;
 }
 
 void lcdc_tcon0_mode_set(struct sunxi_lcdc_reg * const lcdc,
-                        const struct ctfb_res_modes *mode,
+                        const struct display_timing *mode,
                         int clk_div, bool for_ext_vga_dac,
                         int depth, int dclk_phase)
 {
        writel(SUNXI_LCDC_TCON0_DCLK_ENABLE |
               SUNXI_LCDC_TCON0_DCLK_DIV(clk_div), &lcdc->tcon0_dclk);
 
-       writel(SUNXI_LCDC_X(mode->xres) |
-              SUNXI_LCDC_Y(mode->yres), &lcdc->tcon0_timing_active);
+       writel(SUNXI_LCDC_X(mode->hactive.typ) |
+              SUNXI_LCDC_Y(mode->vactive.typ), &lcdc->tcon0_timing_active);
 
-       bp = mode->hsync_len + mode->left_margin;
-       total = mode->xres + mode->right_margin + bp;
+       bp = mode->hsync_len.typ + mode->hback_porch.typ;
+       total = mode->hactive.typ + mode->hfront_porch.typ + bp;
        writel(SUNXI_LCDC_TCON0_TIMING_H_TOTAL(total) |
               SUNXI_LCDC_TCON0_TIMING_H_BP(bp), &lcdc->tcon0_timing_h);
 
-       bp = mode->vsync_len + mode->upper_margin;
-       total = mode->yres + mode->lower_margin + bp;
+       bp = mode->vsync_len.typ + mode->vback_porch.typ;
+       total = mode->vactive.typ + mode->vfront_porch.typ + bp;
        writel(SUNXI_LCDC_TCON0_TIMING_V_TOTAL(total) |
               SUNXI_LCDC_TCON0_TIMING_V_BP(bp), &lcdc->tcon0_timing_v);
 
 #ifdef CONFIG_VIDEO_LCD_IF_PARALLEL
-       writel(SUNXI_LCDC_X(mode->hsync_len) |
-              SUNXI_LCDC_Y(mode->vsync_len), &lcdc->tcon0_timing_sync);
+       writel(SUNXI_LCDC_X(mode->hsync_len.typ) |
+              SUNXI_LCDC_Y(mode->vsync_len.typ), &lcdc->tcon0_timing_sync);
 
        writel(0, &lcdc->tcon0_hv_intf);
        writel(0, &lcdc->tcon0_cpu_intf);
        }
 
        val = SUNXI_LCDC_TCON0_IO_POL_DCLK_PHASE(dclk_phase);
-       if (!(mode->sync & FB_SYNC_HOR_HIGH_ACT))
+       if (mode->flags & DISPLAY_FLAGS_HSYNC_LOW)
                val |= SUNXI_LCDC_TCON_HSYNC_MASK;
-       if (!(mode->sync & FB_SYNC_VERT_HIGH_ACT))
+       if (mode->flags & DISPLAY_FLAGS_VSYNC_LOW)
                val |= SUNXI_LCDC_TCON_VSYNC_MASK;
 
 #ifdef CONFIG_VIDEO_VGA_VIA_LCD_FORCE_SYNC_ACTIVE_HIGH
 }
 
 void lcdc_tcon1_mode_set(struct sunxi_lcdc_reg * const lcdc,
-                        const struct ctfb_res_modes *mode,
+                        const struct display_timing *mode,
                         bool ext_hvsync, bool is_composite)
 {
        int bp, clk_delay, total, val, yres;
 
        clk_delay = lcdc_get_clk_delay(mode, 1);
        writel(SUNXI_LCDC_TCON1_CTRL_ENABLE |
-              ((mode->vmode == FB_VMODE_INTERLACED) ?
+              ((mode->flags & DISPLAY_FLAGS_INTERLACED) ?
                        SUNXI_LCDC_TCON1_CTRL_INTERLACE_ENABLE : 0) |
               SUNXI_LCDC_TCON1_CTRL_CLK_DELAY(clk_delay), &lcdc->tcon1_ctrl);
 
-       yres = mode->yres;
-       if (mode->vmode == FB_VMODE_INTERLACED)
+       yres = mode->vactive.typ;
+       if (mode->flags & DISPLAY_FLAGS_INTERLACED)
                yres /= 2;
-       writel(SUNXI_LCDC_X(mode->xres) | SUNXI_LCDC_Y(yres),
+       writel(SUNXI_LCDC_X(mode->hactive.typ) | SUNXI_LCDC_Y(yres),
               &lcdc->tcon1_timing_source);
-       writel(SUNXI_LCDC_X(mode->xres) | SUNXI_LCDC_Y(yres),
+       writel(SUNXI_LCDC_X(mode->hactive.typ) | SUNXI_LCDC_Y(yres),
               &lcdc->tcon1_timing_scale);
-       writel(SUNXI_LCDC_X(mode->xres) | SUNXI_LCDC_Y(yres),
+       writel(SUNXI_LCDC_X(mode->hactive.typ) | SUNXI_LCDC_Y(yres),
               &lcdc->tcon1_timing_out);
 
-       bp = mode->hsync_len + mode->left_margin;
-       total = mode->xres + mode->right_margin + bp;
+       bp = mode->hsync_len.typ + mode->hback_porch.typ;
+       total = mode->hactive.typ + mode->hfront_porch.typ + bp;
        writel(SUNXI_LCDC_TCON1_TIMING_H_TOTAL(total) |
               SUNXI_LCDC_TCON1_TIMING_H_BP(bp), &lcdc->tcon1_timing_h);
 
-       bp = mode->vsync_len + mode->upper_margin;
-       total = mode->yres + mode->lower_margin + bp;
-       if (mode->vmode == FB_VMODE_NONINTERLACED)
+       bp = mode->vsync_len.typ + mode->vback_porch.typ;
+       total = mode->vactive.typ + mode->vfront_porch.typ + bp;
+       if (!(mode->flags & DISPLAY_FLAGS_INTERLACED))
                total *= 2;
        writel(SUNXI_LCDC_TCON1_TIMING_V_TOTAL(total) |
               SUNXI_LCDC_TCON1_TIMING_V_BP(bp), &lcdc->tcon1_timing_v);
 
-       writel(SUNXI_LCDC_X(mode->hsync_len) |
-              SUNXI_LCDC_Y(mode->vsync_len), &lcdc->tcon1_timing_sync);
+       writel(SUNXI_LCDC_X(mode->hsync_len.typ) |
+              SUNXI_LCDC_Y(mode->vsync_len.typ), &lcdc->tcon1_timing_sync);
 
        if (ext_hvsync) {
                val = 0;
-               if (mode->sync & FB_SYNC_HOR_HIGH_ACT)
+               if (mode->flags & DISPLAY_FLAGS_HSYNC_HIGH)
                        val |= SUNXI_LCDC_TCON_HSYNC_MASK;
-               if (mode->sync & FB_SYNC_VERT_HIGH_ACT)
+               if (mode->flags & DISPLAY_FLAGS_VSYNC_HIGH)
                        val |= SUNXI_LCDC_TCON_VSYNC_MASK;
                writel(val, &lcdc->tcon1_io_polarity);
 
 
                gpio_direction_output(pin, PWM_ON);
 }
 
+static void sunxi_ctfb_mode_to_display_timing(const struct ctfb_res_modes *mode,
+                                             struct display_timing *timing)
+{
+       timing->pixelclock.typ = mode->pixclock_khz * 1000;
+
+       timing->hactive.typ = mode->xres;
+       timing->hfront_porch.typ = mode->right_margin;
+       timing->hback_porch.typ = mode->left_margin;
+       timing->hsync_len.typ = mode->hsync_len;
+
+       timing->vactive.typ = mode->yres;
+       timing->vfront_porch.typ = mode->lower_margin;
+       timing->vback_porch.typ = mode->upper_margin;
+       timing->vsync_len.typ = mode->vsync_len;
+
+       if (mode->sync & FB_SYNC_HOR_HIGH_ACT)
+               timing->flags |= DISPLAY_FLAGS_HSYNC_HIGH;
+       else
+               timing->flags |= DISPLAY_FLAGS_HSYNC_LOW;
+       if (mode->sync & FB_SYNC_VERT_HIGH_ACT)
+               timing->flags |= DISPLAY_FLAGS_VSYNC_HIGH;
+       else
+               timing->flags |= DISPLAY_FLAGS_VSYNC_LOW;
+       if (mode->vmode == FB_VMODE_INTERLACED)
+               timing->flags |= DISPLAY_FLAGS_INTERLACED;
+}
+
 static void sunxi_lcdc_tcon0_mode_set(const struct ctfb_res_modes *mode,
                                      bool for_ext_vga_dac)
 {
        struct sunxi_lcdc_reg * const lcdc =
                (struct sunxi_lcdc_reg *)SUNXI_LCD0_BASE;
        int clk_div, clk_double, pin;
+       struct display_timing timing;
 
 #if defined CONFIG_MACH_SUN8I && defined CONFIG_VIDEO_LCD_IF_LVDS
        for (pin = SUNXI_GPD(18); pin <= SUNXI_GPD(27); pin++) {
 
        sunxi_lcdc_pll_set(0, mode->pixclock_khz, &clk_div, &clk_double);
 
-       lcdc_tcon0_mode_set(lcdc, mode, clk_div, for_ext_vga_dac,
+       sunxi_ctfb_mode_to_display_timing(mode, &timing);
+       lcdc_tcon0_mode_set(lcdc, &timing, clk_div, for_ext_vga_dac,
                            sunxi_display.depth, CONFIG_VIDEO_LCD_DCLK_PHASE);
 }
 
 {
        struct sunxi_lcdc_reg * const lcdc =
                (struct sunxi_lcdc_reg *)SUNXI_LCD0_BASE;
+       struct display_timing timing;
 
-       lcdc_tcon1_mode_set(lcdc, mode, use_portd_hvsync,
+       sunxi_ctfb_mode_to_display_timing(mode, &timing);
+       lcdc_tcon1_mode_set(lcdc, &timing, use_portd_hvsync,
                            sunxi_is_composite());
 
        if (use_portd_hvsync) {