LCD init code

diff --git a/board/pandora/pandora.c b/board/pandora/pandora.c
index 4d11ba5..81c85aa 100644 (file)
--- a/board/pandora/pandora.c
+++ b/board/pandora/pandora.c
@@ -37,6 +37,145 @@
 #include <asm/mach-types.h>
 #include "pandora.h"
 
+/*
+ * Hacky DSS/LCD initialization code
+ */
+
+#define FRAMEBUFFER_ADDRESS 0x80598000
+
+static void sendLcdSpiCommand(uint addr, uint data)
+{
+       data &= 0xff;
+       data |= (addr << 10) | (1 << 8);
+
+       while ( !(*((volatile uint *) 0x48098044) & (1<<1)) );  /* wait for TXS */
+
+       *((volatile uint *) 0x4809804C) = data;
+
+       while ( !(*((volatile uint *) 0x48098044) & (1<<1)) );  /* wait for TXS */
+       while ( !(*((volatile uint *) 0x48098044) & (1<<2)) );  /* wait for EOT */
+}
+
+static void dss_lcd_init(void)
+{
+       *((volatile uint *) 0x48004D44) = 0x0001b00c; /* DPLL4 multiplier/divider (CM_CLKSEL2_PLL) */
+       *((volatile uint *) 0x48004E40) = 0x00001006; /* DSS clock divisors */
+       *((volatile uint *) 0x48004D00) = 0x00370037; /* control DPLL3/4 (CM_CLKEN_PLL) */
+
+       *((volatile uint *) 0x48050010) = 0x00000001;
+       *((volatile uint *) 0x48050410) = 0x00002015;
+       *((volatile uint *) 0x48050444) = 0x00000004;
+       *((volatile uint *) 0x48050464) = 0x0d504300; /* horizontal timing */
+       *((volatile uint *) 0x48050468) = 0x02202700; /* vertical timing */
+       *((volatile uint *) 0x4805046c) = 0x00007028; /* polarities */
+
+       *((volatile uint *) 0x48050470) = 0x00010004;
+
+       *((volatile uint *) 0x4805047c) = 0x01DF031F; /* display size */
+       *((volatile uint *) 0x48050478) = 0x00ef027f;
+       *((volatile uint *) 0x48050480) = FRAMEBUFFER_ADDRESS;
+       *((volatile uint *) 0x48050484) = FRAMEBUFFER_ADDRESS;
+       *((volatile uint *) 0x4805048c) = 0x01DF031F;
+       *((volatile uint *) 0x480504a0) = 0x0000008d;
+       *((volatile uint *) 0x480504a4) = 0x03c00200;
+       *((volatile uint *) 0x480504b8) = 0x807ff000;
+       *((volatile uint *) 0x48050440) = 0x3001836b;
+       udelay(1000);
+       *((volatile uint *) 0x48050440) = 0x3001836b;
+       udelay(1000);
+       *((volatile uint *) 0x48050440) = 0x3001836b;
+}
+
+// TPO LCD GAMMA VALUES
+static const int lcd_gamma_table[12] = {
+       106, 200, 289, 375, 460, 543, 625, 705, 785, 864, 942, 1020
+};
+
+static void lcd_init(void)
+{
+       const int *g = lcd_gamma_table;
+       unsigned char byte;
+       uint i, val;
+
+       /* Enable clock for SPI1 */
+       val = *((volatile uint *) 0x48004A00);
+       val |= (1<<18);
+       *((volatile uint *) 0x48004A00) = val;
+       val = *((volatile uint *) 0x48004A10);
+       val |= (1<<18);
+       *((volatile uint *) 0x48004A10) = val;
+
+       /* Reset module, wait for reset to complete */
+       *((volatile uint *) 0x48098010) = 0x00000002;
+       while ( !(*((volatile uint *) 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 */
+
+       /* Set GPIOs on T2 (Turn on LCD BL) */
+       byte = 0x40;
+       i2c_write(0x49, 0x9B, 1, &byte, 1);
+       byte = 0x40;
+       i2c_write(0x49, 0x9E, 1, &byte, 1);
+
+       /* 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 *)FRAMEBUFFER_ADDRESS, 0, 800*480*2);
+
+       *((volatile uint *) 0x49056094) = 0x20000000; /* Bring LCD out of reset (157) */
+       udelay(2000); /* Need to wait at least 1ms after reset to start sending signals */
+
+       dss_lcd_init();
+
+       /* setup gamma */
+       val = 0;
+       for (i = 0; i < 4; i++)
+               val |= (g[i] & 0x300) >> ((i + 1) * 2);
+       sendLcdSpiCommand(0x11, val);
+
+       val = 0;
+       for (i = 0; i < 4; i++)
+               val |= (g[i+4] & 0x300) >> ((i + 1) * 2);
+       sendLcdSpiCommand(0x12, val);
+
+       val = 0;
+       for (i = 0; i < 4; i++)
+               val |= (g[i+8] & 0x300) >> ((i + 1) * 2);
+       sendLcdSpiCommand(0x13, val);
+
+       for (i = 0; i < 12; i++)
+               sendLcdSpiCommand(0x14 + i, g[i] & 0xff);
+
+       /* other stuff */
+       sendLcdSpiCommand(0x02, 0x0f);
+       sendLcdSpiCommand(0x03, 0xdf);
+       sendLcdSpiCommand(0x04, 0x17);
+       sendLcdSpiCommand(0x20, 0xf0);
+       sendLcdSpiCommand(0x21, 0xf0);
+
+       *((volatile uint *) 0x48098048) = 0x00000000; /* Disable SPI1, CS1 */
+}
+
 /*
  * Routine: board_init
  * Description: Early hardware init.
@@ -79,6 +218,7 @@ int misc_init_r(void)
        writel(GPIO4, &gpio6_base->setdataout);
 
        dieid_num_r();
+       lcd_init();
 
        /* Enable battery backup capacitor (3.2V, 0.5mA charge current) */
        twl4030_i2c_write_u8(TWL4030_CHIP_PM_RECEIVER, 0x1e,