--- /dev/null
+#include <linux/string.h>
+
+#if defined(BUILD_UBOOT)
+#include <asm/arch/mt6575_gpio.h>
+#else
+#include <mach/mt6575_gpio.h>
+#endif
+
+#include "lcm_drv.h"
+
+// ---------------------------------------------------------------------------
+// Local Constants
+// ---------------------------------------------------------------------------
+
+#define FRAME_WIDTH (640)
+#define FRAME_HEIGHT (960)
+
+#define REGFLAG_DELAY 0XFE
+#define REGFLAG_END_OF_TABLE 0xFF // END OF REGISTERS MARKER
+
+#define LCM_DSI_CMD_MODE 0
+
+#ifndef TRUE
+ #define TRUE 1
+#endif
+
+#ifndef FALSE
+ #define FALSE 0
+#endif
+
+// ---------------------------------------------------------------------------
+// Local Variables
+// ---------------------------------------------------------------------------
+
+static LCM_UTIL_FUNCS lcm_util = {0};
+
+#define SET_RESET_PIN(v) (lcm_util.set_reset_pin((v)))
+
+#define UDELAY(n) (lcm_util.udelay(n))
+#define MDELAY(n) (lcm_util.mdelay(n))
+
+
+// ---------------------------------------------------------------------------
+// Local Functions
+// ---------------------------------------------------------------------------
+
+#define dsi_set_cmdq_V2(cmd, count, ppara, force_update) lcm_util.dsi_set_cmdq_V2(cmd, count, ppara, force_update)
+#define dsi_set_cmdq(pdata, queue_size, force_update) lcm_util.dsi_set_cmdq(pdata, queue_size, force_update)
+#define wrtie_cmd(cmd) lcm_util.dsi_write_cmd(cmd)
+#define write_regs(addr, pdata, byte_nums) lcm_util.dsi_write_regs(addr, pdata, byte_nums)
+#define read_reg lcm_util.dsi_read_reg()
+#define read_reg_v2(cmd, buffer, buffer_size) lcm_util.dsi_dcs_read_lcm_reg_v2(cmd, buffer, buffer_size)
+
+
+
+static struct LCM_setting_table {
+ unsigned cmd;
+ unsigned char count;
+ unsigned char para_list[64];
+};
+
+
+static struct LCM_setting_table lcm_initialization_setting[] = {
+
+ /*
+ Note :
+
+ Data ID will depends on the following rule.
+
+ count of parameters > 1 => Data ID = 0x39
+ count of parameters = 1 => Data ID = 0x15
+ count of parameters = 0 => Data ID = 0x05
+
+ Structure Format :
+
+ {DCS command, count of parameters, {parameter list}}
+ {REGFLAG_DELAY, milliseconds of time, {}},
+
+ ...
+
+ Setting ending by predefined flag
+
+ {REGFLAG_END_OF_TABLE, 0x00, {}}
+ */
+
+ {0xB2, 1, {0x00}},
+ {REGFLAG_DELAY, 10, {}},
+
+ {0xB7, 4, {0x01, 0x00, 0x05, 0x00}},
+ {REGFLAG_DELAY, 10, {}},
+
+ {0xC4, 6, {0xDF, 0x01, 0x1C, 0x0C,
+ 0x00, 0x42}},
+ {REGFLAG_DELAY, 10, {}},
+
+ {0xCA, 8, {0x01, 0x80, 0x01, 0x01,
+ 0x7B, 0x33, 0x03, 0x03}},
+ {REGFLAG_DELAY, 10, {}},
+
+ {0xCB, 7, {0x00, 0x00, 0x03, 0x20,
+ 0x03, 0x00, 0x00}},
+ {REGFLAG_DELAY, 10, {}},
+
+ //{0xB2, 1, {0x03}},
+ //{REGFLAG_DELAY, 10, {}},
+
+ // Note
+ // Strongly recommend not to set Sleep out / Display On here. That will cause messed frame to be shown as later the backlight is on.
+
+
+ // Setting ending by predefined flag
+ {REGFLAG_END_OF_TABLE, 0x00, {}}
+};
+
+
+static struct LCM_setting_table lcm_set_window[] = {
+ {0x2A, 4, {0x00, 0x00, (FRAME_WIDTH>>8), (FRAME_WIDTH&0xFF)}},
+ {0x2B, 4, {0x00, 0x00, (FRAME_HEIGHT>>8), (FRAME_HEIGHT&0xFF)}},
+ {REGFLAG_END_OF_TABLE, 0x00, {}}
+};
+
+
+static struct LCM_setting_table lcm_sleep_out_setting[] = {
+ // Sleep Out
+ {0x11, 1, {0x00}},
+ {REGFLAG_DELAY, 120, {}},
+
+ // Display ON
+ {0x29, 1, {0x00}},
+ {REGFLAG_END_OF_TABLE, 0x00, {}}
+};
+
+
+static struct LCM_setting_table lcm_deep_sleep_mode_in_setting[] = {
+ // Display off sequence
+ {0x28, 1, {0x00}},
+
+ // Sleep Mode On
+ {0x10, 1, {0x00}},
+
+ {REGFLAG_END_OF_TABLE, 0x00, {}}
+};
+
+
+static struct LCM_setting_table lcm_backlight_level_setting[] = {
+ {0x51, 1, {0xFF}},
+ {REGFLAG_END_OF_TABLE, 0x00, {}}
+};
+
+
+static void push_table(struct LCM_setting_table *table, unsigned int count, unsigned char force_update)
+{
+ unsigned int i;
+
+ for(i = 0; i < count; i++) {
+
+ unsigned cmd;
+ cmd = table[i].cmd;
+
+ switch (cmd) {
+
+ case REGFLAG_DELAY :
+ MDELAY(table[i].count);
+ break;
+
+ case REGFLAG_END_OF_TABLE :
+ break;
+
+ default:
+ dsi_set_cmdq_V2(cmd, table[i].count, table[i].para_list, force_update);
+ }
+ }
+
+}
+
+
+// ---------------------------------------------------------------------------
+// LCM Driver Implementations
+// ---------------------------------------------------------------------------
+
+static void lcm_set_util_funcs(const LCM_UTIL_FUNCS *util)
+{
+ memcpy(&lcm_util, util, sizeof(LCM_UTIL_FUNCS));
+}
+
+
+static void lcm_get_params(LCM_PARAMS *params)
+{
+ memset(params, 0, sizeof(LCM_PARAMS));
+
+ params->type = LCM_TYPE_DSI;
+
+ params->width = FRAME_WIDTH;
+ params->height = FRAME_HEIGHT;
+
+ // enable tearing-free
+ params->dbi.te_mode = LCM_DBI_TE_MODE_VSYNC_ONLY;
+ params->dbi.te_edge_polarity = LCM_POLARITY_RISING;
+
+#if (LCM_DSI_CMD_MODE)
+ params->dsi.mode = CMD_MODE;
+#else
+ params->dsi.mode = SYNC_PULSE_VDO_MODE;
+#endif
+
+ // DSI
+ /* Command mode setting */
+ params->dsi.LANE_NUM = LCM_TWO_LANE;
+ //The following defined the fomat for data coming from LCD engine.
+ params->dsi.data_format.color_order = LCM_COLOR_ORDER_RGB;
+ params->dsi.data_format.trans_seq = LCM_DSI_TRANS_SEQ_MSB_FIRST;
+ params->dsi.data_format.padding = LCM_DSI_PADDING_ON_LSB;
+ params->dsi.data_format.format = LCM_DSI_FORMAT_RGB888;
+
+ // Highly depends on LCD driver capability.
+ // Not support in MT6573
+ params->dsi.packet_size=256;
+
+ // Video mode setting
+ params->dsi.intermediat_buffer_num = 3;
+
+ params->dsi.PS=LCM_PACKED_PS_24BIT_RGB888;
+ params->dsi.word_count=480*3;
+
+ params->dsi.vertical_sync_active = 16;
+ params->dsi.vertical_backporch = 12;
+ params->dsi.vertical_frontporch = 12;
+ params->dsi.vertical_active_line = FRAME_HEIGHT;
+
+ params->dsi.horizontal_sync_active = 16;
+ params->dsi.horizontal_backporch = 14;
+ params->dsi.horizontal_frontporch = 14;
+ params->dsi.horizontal_active_pixel = FRAME_WIDTH;
+
+ // Bit rate calculation
+ params->dsi.pll_div1=37; // fref=26MHz, fvco=fref*(div1+1) (div1=0~63, fvco=500MHZ~1GHz)
+ params->dsi.pll_div2=1; // div2=0~15: fout=fvo/(2*div2)
+
+ /* ESD or noise interference recovery For video mode LCM only. */
+ // Send TE packet to LCM in a period of n frames and check the response.
+ params->dsi.lcm_int_te_monitor = FALSE;
+ params->dsi.lcm_int_te_period = 1; // Unit : frames
+
+ // Need longer FP for more opportunity to do int. TE monitor applicably.
+ if(params->dsi.lcm_int_te_monitor)
+ params->dsi.vertical_frontporch *= 2;
+
+ // Monitor external TE (or named VSYNC) from LCM once per 2 sec. (LCM VSYNC must be wired to baseband TE pin.)
+ params->dsi.lcm_ext_te_monitor = FALSE;
+ // Non-continuous clock
+ params->dsi.noncont_clock = TRUE;
+ params->dsi.noncont_clock_period = 2; // Unit : frames
+
+}
+
+#define GPIO_PIN_1V8 21
+#define GPIO_PIN_5V7 19
+
+extern void DSI_clk_HS_mode(bool enter);
+static unsigned int is_init = false;
+
+static void lcm_init(void)
+{
+ unsigned char buffer[5];
+ unsigned int data_array[16];
+
+ DSI_clk_HS_mode(0);
+
+ mt_set_gpio_out(GPIO_PIN_5V7, GPIO_OUT_ZERO);
+ mt_set_gpio_out(GPIO_PIN_1V8, GPIO_OUT_ZERO);
+
+ mt_set_gpio_mode(GPIO_PIN_5V7, GPIO_MODE_GPIO);
+ mt_set_gpio_mode(GPIO_PIN_1V8, GPIO_MODE_GPIO);
+ SET_RESET_PIN(0);
+
+ mt_set_gpio_dir(GPIO_PIN_5V7, GPIO_DIR_OUT);
+ mt_set_gpio_dir(GPIO_PIN_1V8, GPIO_DIR_OUT);
+
+ MDELAY(100);
+
+ mt_set_gpio_out(GPIO_PIN_1V8, GPIO_OUT_ONE);
+ MDELAY(100);
+
+ mt_set_gpio_out(GPIO_PIN_5V7, GPIO_OUT_ONE);
+ MDELAY(100);
+
+ // SET_RESET_PIN(1);
+ SET_RESET_PIN(0);
+ MDELAY(100);
+ SET_RESET_PIN(1);
+ MDELAY(100);
+
+ // Enable high speed clock
+ DSI_clk_HS_mode(1);
+ MDELAY(10);
+
+ push_table(lcm_sleep_out_setting, sizeof(lcm_sleep_out_setting) / sizeof(struct LCM_setting_table), 1);
+ push_table(lcm_initialization_setting, sizeof(lcm_initialization_setting) / sizeof(struct LCM_setting_table), 1);
+
+ data_array[0] = 0x00043700;
+ dsi_set_cmdq(data_array, 1, 1);
+ read_reg_v2(0xB7, buffer, 4);
+
+ is_init = true;
+
+}
+
+
+static void lcm_suspend(void)
+{
+ //push_table(lcm_deep_sleep_mode_in_setting, sizeof(lcm_deep_sleep_mode_in_setting) / sizeof(struct LCM_setting_table), 1);
+
+ SET_RESET_PIN(0);
+ MDELAY(10);
+ SET_RESET_PIN(1);
+
+ mt_set_gpio_out(GPIO_PIN_5V7, GPIO_OUT_ZERO);
+ mt_set_gpio_out(GPIO_PIN_1V8, GPIO_OUT_ZERO);
+
+ is_init = false;
+}
+
+
+static void lcm_resume(void)
+{
+ if (!is_init)
+ lcm_init();
+
+ //push_table(lcm_sleep_out_setting, sizeof(lcm_sleep_out_setting) / sizeof(struct LCM_setting_table), 1);
+}
+
+
+static void lcm_update(unsigned int x, unsigned int y,
+ unsigned int width, unsigned int height)
+{
+ unsigned int x0 = x;
+ unsigned int y0 = y;
+ unsigned int x1 = x0 + width - 1;
+ unsigned int y1 = y0 + height - 1;
+
+ unsigned char x0_MSB = ((x0>>8)&0xFF);
+ unsigned char x0_LSB = (x0&0xFF);
+ unsigned char x1_MSB = ((x1>>8)&0xFF);
+ unsigned char x1_LSB = (x1&0xFF);
+ unsigned char y0_MSB = ((y0>>8)&0xFF);
+ unsigned char y0_LSB = (y0&0xFF);
+ unsigned char y1_MSB = ((y1>>8)&0xFF);
+ unsigned char y1_LSB = (y1&0xFF);
+
+ unsigned int data_array[16];
+
+ data_array[0]= 0x00053902;
+ data_array[1]= (x1_MSB<<24)|(x0_LSB<<16)|(x0_MSB<<8)|0x2a;
+ data_array[2]= (x1_LSB);
+ data_array[3]= 0x00053902;
+ data_array[4]= (y1_MSB<<24)|(y0_LSB<<16)|(y0_MSB<<8)|0x2b;
+ data_array[5]= (y1_LSB);
+ data_array[6]= 0x002c3909;
+
+ dsi_set_cmdq(&data_array, 7, 0);
+
+}
+
+
+static void lcm_setbacklight(unsigned int level)
+{
+ unsigned int default_level = 145;
+ unsigned int mapped_level = 0;
+
+ //for LGE backlight IC mapping table
+ if(level > 255)
+ level = 255;
+
+ if(level >0)
+ mapped_level = default_level+(level)*(255-default_level)/(255);
+ else
+ mapped_level=0;
+
+ // Refresh value of backlight level.
+ lcm_backlight_level_setting[0].para_list[0] = mapped_level;
+
+ push_table(lcm_backlight_level_setting, sizeof(lcm_backlight_level_setting) / sizeof(struct LCM_setting_table), 1);
+}
+
+
+static void lcm_setpwm(unsigned int divider)
+{
+ // TBD
+}
+
+
+static unsigned int lcm_getpwm(unsigned int divider)
+{
+ // ref freq = 15MHz, B0h setting 0x80, so 80.6% * freq is pwm_clk;
+ // pwm_clk / 255 / 2(lcm_setpwm() 6th params) = pwm_duration = 23706
+ unsigned int pwm_clk = 23706 / (1<<divider);
+ return pwm_clk;
+}
+
+static unsigned int lcm_esd_recover()
+{
+ lcm_init();
+
+ return true;
+}
+
+LCM_DRIVER r63303_idisplay_lcm_drv =
+{
+ .name = "r63303_idisplay",
+ .set_util_funcs = lcm_set_util_funcs,
+ .get_params = lcm_get_params,
+ .init = lcm_init,
+ .suspend = lcm_suspend,
+ .resume = lcm_resume,
+ .esd_recover = lcm_esd_recover,
+#if (LCM_DSI_CMD_MODE)
+ .update = lcm_update,
+#endif
+};
+