--- /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 */