--- /dev/null
+#include <common.h>
+#include <asm/io.h>
+#include <lcd.h>
+#include <twl4030.h>
+
+#ifdef CONFIG_LCD
+
+#define TWL_INTBR_PMBR1        0x92
+#define GPIODATADIR1   0x9b
+#define SETGPIODATAOUT1        0xa4
+
+/*
+ * Hacky DSS/LCD initialization code
+ */
+
+static void dss_lcd_init(uint base_addr)
+{
+       *((volatile uint *) 0x48004D44) = 0x0001b00c; /* DPLL4 multiplier/divider (CM_CLKSEL2_PLL) */
+       *((volatile uint *) 0x48004E40) = 0x0000100c; /* DSS clock divisors */
+       *((volatile uint *) 0x48004D00) = 0x00370037; /* control DPLL3/4 (CM_CLKEN_PLL) */
+
+       *((volatile uint *) 0x48050010) = 0x00000003;
+       while ( !(*((volatile uint *) 0x48050014) & 1) ); /* wait for reset to finish */
+
+       *((volatile uint *) 0x48050410) = 0x00002015;
+       *((volatile uint *) 0x48050444) = 0x00000004;
+       *((volatile uint *) 0x48050464) = 0x0d504300; /* horizontal timing */
+       *((volatile uint *) 0x48050468) = 0x02202700; /* vertical timing */
+       *((volatile uint *) 0x4805046c) = 0x00007000; /* polarities */
+
+       *((volatile uint *) 0x48050470) = 0x00010002;
+
+       *((volatile uint *) 0x4805047c) = 0x01df031f; /* display size */
+       *((volatile uint *) 0x48050480) = base_addr;
+       *((volatile uint *) 0x48050484) = base_addr;
+       *((volatile uint *) 0x4805048c) = 0x01df031f;
+       *((volatile uint *) 0x480504a0) = 0x0000008d;
+       *((volatile uint *) 0x480504a4) = 0x03c00200;
+
+       *((volatile uint *) 0x48050440) = 0x00018329;
+       while (*((volatile uint *) 0x48050440) & (1<<5)); /* wait for GOLCD */
+       *((volatile uint *) 0x48050440) = 0x00018329;
+}
+
+/* SPI stuff to set correct clock polarity in the LCD */
+static void lcd_spi_init(void)
+{
+       /* Enable clock for SPI1 */
+       writel(readl(0x48004A00) | (1<<18), 0x48004A00);
+       writel(readl(0x48004A10) | (1<<18), 0x48004A10);
+
+       /* Reset module, wait for reset to complete */
+       writel(0x00000002, 0x48098010);
+       while ( !(readl(0x48098014) & 1) );
+
+       /* SPI1 base address = 0x48098000 for CS0,
+        * for CS1 add 0x14 to the offset where applicable */
+       *((volatile uint *) 0x48098034) = 0x00000000; /* CS0 +8 */
+       *((volatile uint *) 0x48098048) = 0x00000000; /* CS1 +8 */
+       *((volatile uint *) 0x4809801C) = 0x00000000;
+       *((volatile uint *) 0x48098018) = 0xFFFFFFFF;
+       *((volatile uint *) 0x48098024) = 0x00000000;
+       *((volatile uint *) 0x48098028) = 0x00000000;
+       *((volatile uint *) 0x48098010) = 0x00000308;
+       *((volatile uint *) 0x48098040) = 0x020127DC;
+       *((volatile uint *) 0x48098048) = 0x00000001; /* CS1 */
+}
+
+static void lcd_spi_write(uint addr, uint data)
+{
+       data &= 0xff;
+       data |= (addr << 10) | (1 << 8);
+
+       while ( !(readl(0x48098044) & (1<<1)) );        /* wait for TXS */
+
+       writel(data, 0x4809804C);
+
+       while ( !(readl(0x48098044) & (1<<1)) );        /* wait for TXS */
+       while ( !(readl(0x48098044) & (1<<2)) );        /* wait for EOT */
+}
+
+static void lcd_init(void)
+{
+       DECLARE_GLOBAL_DATA_PTR;
+       u8 d;
+
+       /* make sure LCD nreset is driven low (GPIO157)
+        * (we are called before misc_init_r() which normally handles this stuff) */
+       writel(0x20000000, 0x49056090);
+       writel(readl(0x49056034) & ~0x20000000, 0x49056034);
+       /* also GPIO164 (some audible noise otherwise) */
+       writel(0x10, 0x49058094);
+       writel(readl(0x49058034) & ~0x10, 0x49058034);
+
+       lcd_spi_init();
+
+       /* set VPLL2 to 1.8V */
+       twl4030_i2c_write_u8(TWL4030_CHIP_PM_RECEIVER, 0x05,
+                            TWL4030_PM_RECEIVER_VPLL2_DEDICATED);
+       twl4030_i2c_write_u8(TWL4030_CHIP_PM_RECEIVER, 0x20,
+                            TWL4030_PM_RECEIVER_VPLL2_DEV_GRP);
+
+       /* set VAUX1 to 3.0V (LCD) */
+       twl4030_i2c_write_u8(TWL4030_CHIP_PM_RECEIVER, 0x04,
+                            TWL4030_PM_RECEIVER_VAUX1_DEDICATED);
+       twl4030_i2c_write_u8(TWL4030_CHIP_PM_RECEIVER, 0x20,
+                            TWL4030_PM_RECEIVER_VAUX1_DEV_GRP);
+
+       /* Clear frame buffer */
+       memset((void *)gd->fb_base, 0, 800*480*2);
+
+       writel(0x20000000, 0x49056094); /* Bring LCD out of reset (157) */
+       udelay(2000); /* Need to wait at least 1ms after reset to start sending signals */
+
+       dss_lcd_init((uint)gd->fb_base);
+
+       lcd_spi_write(0x02, 0x0f);
+       writel(0, 0x48098048); /* Disable SPI1, CS1 */
+
+       /* Set GPIOs on T2 (Turn on LCD BL) */
+       twl4030_i2c_read_u8(TWL4030_CHIP_INTBR, &d, TWL_INTBR_PMBR1);
+       d &= ~0x0c; /* switch to GPIO function */
+       twl4030_i2c_write_u8(TWL4030_CHIP_INTBR, d, TWL_INTBR_PMBR1);
+
+       twl4030_i2c_read_u8(TWL4030_CHIP_GPIO, &d, GPIODATADIR1);
+       d |= 0x40; /* GPIO6 */
+       twl4030_i2c_write_u8(TWL4030_CHIP_GPIO, d, GPIODATADIR1);
+       twl4030_i2c_write_u8(TWL4030_CHIP_GPIO, 0x40, SETGPIODATAOUT1);
+}
+
+/* u-boot LCD driver support */
+vidinfo_t panel_info = {
+       800, 480, LCD_BPP
+};
+
+/* vars managed by lcd.c */
+int lcd_line_length;
+int lcd_color_fg;
+int lcd_color_bg;
+void *lcd_base;
+void *lcd_console_address;
+short console_col;
+short console_row;
+
+void lcd_enable(void)
+{
+}
+
+void lcd_ctrl_init(void *lcdbase)
+{
+       lcd_init();
+}
+
+/* Calculate fb size for VIDEOLFB_ATAG. */
+ulong calc_fbsize(void)
+{
+       return (panel_info.vl_col * panel_info.vl_row *
+               NBITS(panel_info.vl_bpix) / 8);
+}
+
+#endif /* CONFIG_LCD */