Initial file dump from open source releaseHEADmaster

1 files changed, 441 insertions, 0 deletions

diff --git a/drivers/video/sprdfb/lcd/lcd_nt35516_mipi.c b/drivers/video/sprdfb/lcd/lcd_nt35516_mipi.c
new file mode 100644
index 00000000..0fa94268
--- /dev/null
+++ b/drivers/video/sprdfb/lcd/lcd_nt35516_mipi.c
@@ -0,0 +1,441 @@
+/* drivers/video/sc8825/lcd_nt35516_mipi.c

+ *

+ * Support for nt35516 mipi LCD device

+ *

+ * Copyright (C) 2010 Spreadtrum

+ *

+ * This software is licensed under the terms of the GNU General Public

+ * License version 2, as published by the Free Software Foundation, and

+ * may be copied, distributed, and modified under those terms.

+ *

+ * This program is distributed in the hope that it will be useful,

+ * but WITHOUT ANY WARRANTY; without even the implied warranty of

+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

+ * GNU General Public License for more details.

+ */

+

+#include <linux/kernel.h>

+#include <linux/bug.h>

+#include <linux/delay.h>

+#include "../sprdfb_panel.h"

+

+//#define LCD_Delay(ms)  uDelay(ms*1000)

+

+#define MAX_DATA   48

+

+typedef struct LCM_Init_Code_tag {

+	unsigned int tag;

+	unsigned char data[MAX_DATA];

+}LCM_Init_Code;

+

+typedef struct LCM_force_cmd_code_tag{

+	unsigned int datatype;

+	LCM_Init_Code real_cmd_code;

+}LCM_Force_Cmd_Code;

+

+#define LCM_TAG_SHIFT 24

+#define LCM_TAG_MASK  ((1 << 24) -1)

+#define LCM_SEND(len) ((1 << LCM_TAG_SHIFT)| len)

+#define LCM_SLEEP(ms) ((2 << LCM_TAG_SHIFT)| ms)

+//#define ARRAY_SIZE(array) ( sizeof(array) / sizeof(array[0]))

+

+#define LCM_TAG_SEND  (1<< 0)

+#define LCM_TAG_SLEEP (1 << 1)

+

+static LCM_Init_Code init_data[] = {

+#if 1

+// NT35516, LGD

+// VCC=2.8V, IOVCC=1.8V

+{LCM_SEND(7), {5, 0, 0xFF,0xAA,0x55,0x25,0x01}},

+{LCM_SEND(38), {36, 0, 0xF2,0x00,0x00,0x4A,0x0A,0xA8,0x00,0x00,

+	0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x0B,0x00,

+	0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x40,0x01,0x51,

+	0x00,0x01,0x00,0x01}},

+{LCM_SEND(10), {8, 0, 0xF3,0x02,0x03,0x07,0x45,0x88,0xD1,0x0D}},

+// Manufacture Command Set for Page 0

+{LCM_SEND(8), {6, 0, 0xF0,0x55,0xAA,0x52,0x08,0x00}},

+{LCM_SEND(6), {4, 0, 0xB1,0x7C,0x00,0x00}}, // command/video mode

+#if (defined CONFIG_FB_SCX35) || (defined CONFIG_FB_SCX30G)

+{LCM_SEND(6), {4, 0, 0xB1,0x7C,0x06,0x00}}, // command/video mode,rotate 180^M

+#else

+ {LCM_SEND(6), {4, 0, 0xB1,0x7C,0x00,0x00}}, // command/video mode

+#endif

+{LCM_SEND(7), {5, 0, 0xB8,0x01,0x02,0x02,0x02}},

+{LCM_SEND(6), {4, 0, 0xBC,0x00,0x00,0x00}},  // inversion

+{LCM_SEND(9), {7, 0, 0xC9,0x63,0x06,0x0D,0x1A,0x17,0x00}},

+// Manufacture Command Set for Page 1

+{LCM_SEND(8), {6, 0, 0xF0,0x55,0xAA,0x52,0x08,0x01}},

+{LCM_SEND(6), {4, 0, 0xB0,0x05,0x05,0x05}},

+{LCM_SEND(6), {4, 0, 0xB1,0x05,0x05,0x05}},

+{LCM_SEND(6), {4, 0, 0xB2,0x01,0x01,0x01}},

+{LCM_SEND(6), {4, 0, 0xB3,0x0D,0x0D,0x0D}},

+{LCM_SEND(6), {4, 0, 0xB4,0x09,0x09,0x09}},

+{LCM_SEND(6), {4, 0, 0xB6,0x44,0x44,0x44}},

+{LCM_SEND(6), {4, 0, 0xB7,0x34,0x34,0x34}},

+{LCM_SEND(6), {4, 0, 0xB8,0x10,0x10,0x10}},

+{LCM_SEND(6), {4, 0, 0xB9,0x36,0x36,0x36}},

+{LCM_SEND(6), {4, 0, 0xBA,0x24,0x24,0x24}},

+{LCM_SEND(6), {4, 0, 0xBC,0x00,0xD0,0x00}},

+{LCM_SEND(6), {4, 0, 0xBD,0x00,0xD0,0x00}},

+{LCM_SEND(2), {0xBE,0x5D}},

+{LCM_SEND(5), {3, 0, 0xC0,0x04,0x00}},

+{LCM_SEND(2), {0xCA,0x00}},

+// Gradient Control for Gamma Voltage

+{LCM_SEND(7), {5, 0, 0xD0,0x0A,0x10,0x0D,0x0F}},

+{LCM_SEND(19), {17, 0, 0xD1,0x00,0xA7,0x01,0x0F,0x01,0x34,0x01,0x49,0x01,0x56,0x01,0x75,0x01,0x8F,0x01,0xB7}},

+{LCM_SEND(19), {17, 0, 0xD2,0x01,0xD1,0x02,0x03,0x02,0x23,0x02,0x57,0x02,0x85,0x02,0x87,0x02,0xAA,0x02,0xE1}},

+{LCM_SEND(19), {17, 0, 0xD3,0x03,0x04,0x03,0x31,0x03,0x42,0x03,0x6D,0x03,0x83,0x03,0x9C,0x03,0xAA,0x03,0xCD}},

+{LCM_SEND(7), {5, 0, 0xD4,0x03,0xEF,0x03,0xFF}},

+{LCM_SEND(19), {17, 0, 0xD5,0x00,0xA7,0x01,0x0F,0x01,0x34,0x01,0x49,0x01,0x56,0x01,0x75,0x01,0x8F,0x01,0xB7}},

+{LCM_SEND(19), {17, 0, 0xD6,0x01,0xD1,0x02,0x03,0x02,0x23,0x02,0x57,0x02,0x85,0x02,0x87,0x02,0xAA,0x02,0xE1}},

+{LCM_SEND(19), {17, 0, 0xD7,0x03,0x04,0x03,0x31,0x03,0x42,0x03,0x6D,0x03,0x83,0x03,0x9C,0x03,0xAA,0x03,0xCD}},

+{LCM_SEND(7), {5, 0, 0xD8,0x03,0xEF,0x03,0xFF}},

+{LCM_SEND(19), {17, 0, 0xD9,0x00,0xA7,0x01,0x0F,0x01,0x34,0x01,0x49,0x01,0x56,0x01,0x75,0x01,0x8F,0x01,0xB7}},

+{LCM_SEND(19), {17, 0, 0xDD,0x01,0xD1,0x02,0x03,0x02,0x23,0x02,0x57,0x02,0x85,0x02,0x87,0x02,0xAA,0x02,0xE1}},

+{LCM_SEND(19), {17, 0, 0xDE,0x03,0x04,0x03,0x31,0x03,0x42,0x03,0x6D,0x03,0x83,0x03,0x9C,0x03,0xAA,0x03,0xCD}},

+{LCM_SEND(7), {5, 0, 0xDF,0x03,0xEF,0x03,0xFF}},

+{LCM_SEND(19), {17, 0, 0xE0,0x00,0xA7,0x01,0x0F,0x01,0x34,0x01,0x49,0x01,0x56,0x01,0x75,0x01,0x8F,0x01,0xB7}},

+{LCM_SEND(19), {17, 0, 0xE1,0x01,0xD1,0x02,0x03,0x02,0x23,0x02,0x57,0x02,0x85,0x02,0x87,0x02,0xAA,0x02,0xE1}},

+{LCM_SEND(19), {17, 0, 0xE2,0x03,0x04,0x03,0x31,0x03,0x42,0x03,0x6D,0x03,0x83,0x03,0x9C,0x03,0xAA,0x03,0xCD}},

+{LCM_SEND(7), {5, 0, 0xE3,0x03,0xEF,0x03,0xFF}},

+{LCM_SEND(19), {17, 0, 0xE4,0x00,0xA7,0x01,0x0F,0x01,0x34,0x01,0x49,0x01,0x56,0x01,0x75,0x01,0x8F,0x01,0xB7}},

+{LCM_SEND(19), {17, 0, 0xE5,0x01,0xD1,0x02,0x03,0x02,0x23,0x02,0x57,0x02,0x85,0x02,0x87,0x02,0xAA,0x02,0xE1}},

+{LCM_SEND(19), {17, 0, 0xE6,0x03,0x04,0x03,0x31,0x03,0x42,0x03,0x6D,0x03,0x83,0x03,0x9C,0x03,0xAA,0x03,0xCD}},

+{LCM_SEND(7), {5, 0, 0xE7,0x03,0xEF,0x03,0xFF}},

+{LCM_SEND(19), {17, 0, 0xE8,0x00,0xA7,0x01,0x0F,0x01,0x34,0x01,0x49,0x01,0x56,0x01,0x75,0x01,0x8F,0x01,0xB7}},

+{LCM_SEND(19), {17, 0, 0xE9,0x01,0xD1,0x02,0x03,0x02,0x23,0x02,0x57,0x02,0x85,0x02,0x87,0x02,0xAA,0x02,0xE1}},

+{LCM_SEND(19), {17, 0, 0xEA,0x03,0x04,0x03,0x31,0x03,0x42,0x03,0x6D,0x03,0x83,0x03,0x9C,0x03,0xAA,0x03,0xCD}},

+{LCM_SEND(7), {5, 0, 0xEB,0x03,0xEF,0x03,0xFF}},

+// User Command Set

+{LCM_SEND(2), {0x35,0x00}}, // Tearing Effect On

+{LCM_SEND(5), {3, 0, 0x44, 0x03, 0x98}}, //set te scan line to 920

+{LCM_SEND(2), {0x3A,0x77}}, // Interface Pixel Format

+{LCM_SEND(2), {0x36,0x00}}, // Memory Data Access Control

+{LCM_SEND(1), {0x22}}, // all pixel off

+{LCM_SEND(1), {0x11}}, // sleep out

+{LCM_SLEEP(120)},

+{LCM_SEND(1), {0x29}}, // display on

+{LCM_SLEEP(100)},

+{LCM_SEND(2), {0x13,0x00}}, // normal on

+#endif

+

+#if 0

+{LCM_SEND(7), {0x5, 0, 0xFF, 0xAA, 0x55, 0x25, 0x01}},

+{LCM_SEND(7), {0x5, 0, 0xF3, 0x02, 0x03, 0x07, 0x15}},

+{LCM_SEND(8), {0x6, 0, 0xF0, 0x55, 0xAA, 0x52, 0x08, 0x00}},

+//{LCM_SEND(8), {0x06, 0, 0xF0,0x55,0xAA,0x52,0x08,0x00}},

+//{LCM_SEND(8), {0x06, 0, 0xBD,0x02,0xC8,0x14,0x3C,0x01}},

+{LCM_SEND(2), {0xB1, 0xFC}},

+

+{LCM_SEND(7), {0x5, 0, 0xB8, 0x01, 0x02, 0x02, 0x02}},

+{LCM_SEND(6), {0x4, 0, 0xBC, 0x05, 0x05, 0x05}}, //Zig-Zag Inversion

+{LCM_SEND(8), {0x6, 0, 0xF0, 0x55, 0xAA, 0x52, 0x08, 0x01}},

+{LCM_SEND(6), {0x4, 0, 0xB0, 0x05, 0x05, 0x05}},

+{LCM_SEND(6), {0x4, 0, 0xB1, 0x05, 0x05, 0x05}},

+{LCM_SEND(6), {0x4, 0, 0xB6, 0x34, 0x34, 0x34}},

+{LCM_SEND(6), {0x4, 0, 0xB7, 0x24, 0x24, 0x24}},

+{LCM_SEND(6), {0x4, 0, 0xB3, 0x10, 0x10, 0x10}},

+{LCM_SEND(6), {0x4, 0, 0xB9, 0x34, 0x34, 0x34}},

+{LCM_SEND(6), {0x4, 0, 0xB4, 0x0A, 0x0A, 0x0A}},

+{LCM_SEND(6), {0x4, 0, 0xBA, 0x14, 0x14, 0x14}},

+{LCM_SEND(6), {0x4, 0, 0xBC, 0x00, 0xA0, 0x00}},

+{LCM_SEND(6), {0x4, 0, 0xBD, 0x00, 0xA0, 0x00}},

+{LCM_SEND(2), {0xBE, 0x4E}},

+

+{LCM_SEND(19),{17,  0, 0xD1, 0x00, 0x32, 0x00, 0x41, 0x00, 0x54, 0x00, 0x67, 0x00, 0x7A, 0x00, 0x98, 0x00, 0xB0, 0x00, 0xDB}},

+{LCM_SEND(19),{17,  0, 0xD2, 0x01, 0x01, 0x01, 0x3F, 0x01, 0x70, 0x01, 0xB4, 0x01, 0xEC, 0x01, 0xED, 0x02, 0x1E, 0x02, 0x51}},

+{LCM_SEND(19),{17,  0, 0xD3, 0x02, 0x6C, 0x02, 0x8D, 0x02, 0xA5, 0x02, 0xC9, 0x02, 0xEA, 0x03, 0x19, 0x03, 0x45, 0x03, 0x7A}},

+{LCM_SEND(7), { 5, 0, 0xD4, 0x03, 0xB0, 0x03, 0xF4}},

+{LCM_SEND(19),{17,  0, 0xD5, 0x00, 0x32, 0x00, 0x41, 0x00, 0x54, 0x00, 0x67, 0x00, 0x7A, 0x00, 0x98, 0x00, 0xB0, 0x00, 0xDB}},

+{LCM_SEND(19),{17,  0, 0xD6, 0x01, 0x01, 0x01, 0x3F, 0x01, 0x70, 0x01, 0xB4, 0x01, 0xEC, 0x01, 0xED, 0x02, 0x1E, 0x02, 0x51}},

+{LCM_SEND(19),{17,  0, 0xD7, 0x02, 0x6C, 0x02, 0x8D, 0x02, 0xA5, 0x02, 0xC9, 0x02, 0xEA, 0x03, 0x19, 0x03, 0x45, 0x03, 0x7A}},

+{LCM_SEND(7), {0x7, 0, 0xD8, 0x03, 0xB0, 0x03, 0xF4}},

+{LCM_SEND(19),{17,  0, 0xD9, 0x00, 0x32, 0x00, 0x41, 0x00, 0x54, 0x00, 0x67, 0x00, 0x7A, 0x00, 0x98, 0x00, 0xB0, 0x00, 0xDB}},

+{LCM_SEND(19),{17,  0,0xDD, 0x01, 0x01, 0x01, 0x3F, 0x01, 0x70, 0x01, 0xB4, 0x01, 0xEC, 0x01, 0xED, 0x02, 0x1E, 0x02, 0x51}},

+{LCM_SEND(19),{17, 0, 0xDE, 0x02, 0x6C, 0x02, 0x8D, 0x02, 0xA5, 0x02, 0xC9, 0x02, 0xEA, 0x03, 0x19, 0x03, 0x45, 0x03, 0x7A}},

+{LCM_SEND(7), {0x5, 0, 0xDF, 0x03, 0xB0, 0x03, 0xF4}},

+{LCM_SEND(19),{17,  0, 0xE0, 0x00, 0x32, 0x00, 0x41, 0x00, 0x54, 0x00, 0x67, 0x00, 0x7A, 0x00, 0x98, 0x00, 0xB0, 0x00, 0xDB}},

+{LCM_SEND(19),{17,  0 ,0xE1, 0x01, 0x01, 0x01, 0x3F, 0x01, 0x70, 0x01, 0xB4, 0x01, 0xEC, 0x01, 0xED, 0x02, 0x1E, 0x02, 0x51}},

+{LCM_SEND(19),{17,  0,0xE2, 0x02, 0x6C, 0x02, 0x8D, 0x02, 0xA5, 0x02, 0xC9, 0x02, 0xEA, 0x03, 0x19, 0x03, 0x45, 0x03, 0x7A}},

+{LCM_SEND(7), {5, 0, 0xE3, 0x03, 0xB0, 0x03, 0xF4}},

+{LCM_SEND(19),{17,  0, 0xE4, 0x00, 0x32, 0x00, 0x41, 0x00, 0x54, 0x00, 0x67, 0x00, 0x7A, 0x00, 0x98, 0x00, 0xB0, 0x00, 0xDB}},

+{LCM_SEND(19),{17,  0,0xE5, 0x01, 0x01, 0x01, 0x3F, 0x01, 0x70, 0x01, 0xB4, 0x01, 0xEC, 0x01, 0xED, 0x02, 0x1E, 0x02, 0x51}},

+{LCM_SEND(19),{17,  0, 0xE6, 0x02, 0x6C, 0x02, 0x8D, 0x02, 0xA5, 0x02, 0xC9, 0x02, 0xEA, 0x03, 0x19, 0x03, 0x45, 0x03, 0x7A}},

+{LCM_SEND(7), {5, 0, 0xE7, 0x03, 0xB0, 0x03, 0xF4}},

+{LCM_SEND(19),{17 , 0, 0xE8, 0x00, 0x32, 0x00, 0x41, 0x00, 0x54, 0x00, 0x67, 0x00, 0x7A, 0x00, 0x98, 0x00, 0xB0, 0x00, 0xDB}},

+{LCM_SEND(19),{17,  0, 0xE9, 0x01, 0x01, 0x01, 0x3F, 0x01, 0x70, 0x01, 0xB4, 0x01, 0xEC, 0x01, 0xED, 0x02, 0x1E, 0x02, 0x51}},

+{LCM_SEND(19),{17,  0, 0xEA, 0x02, 0x6C, 0x02, 0x8D, 0x02, 0xA5, 0x02, 0xC9, 0x02, 0xEA, 0x03, 0x19, 0x03, 0x45, 0x03, 0x7A}},

+{LCM_SEND(7), {0x5, 0, 0xEB, 0x03, 0xB0, 0x03, 0xF4}},

+{LCM_SEND(2), {0x3A, 0x77}},

+{LCM_SEND(2), {0x35, 0x00}},

+{LCM_SEND(2), {0x4C, 0x11}},

+

+#endif

+#if 0

+{LCM_SEND(1), {0x11}},//0x11

+{LCM_SLEEP(200),},

+{LCM_SEND(1), {0x29}},//0x29

+#endif

+};

+

+//static LCM_Init_Code disp_on =  {LCM_SEND(1), {0x29}};

+

+static LCM_Init_Code sleep_in[] =  {

+{LCM_SEND(1), {0x28}},

+{LCM_SLEEP(10)},

+{LCM_SEND(1), {0x10}},

+{LCM_SLEEP(120)},

+//{LCM_SEND(2), {0x4f, 0x01}}, /* this code may cause not resume bug*/

+};

+

+static LCM_Init_Code sleep_out[] =  {

+{LCM_SEND(1), {0x11}},

+{LCM_SLEEP(120)},

+{LCM_SEND(1), {0x29}},

+{LCM_SLEEP(20)},

+};

+

+static LCM_Force_Cmd_Code rd_prep_code[]={

+	{0x39, {LCM_SEND(8), {0x6, 0, 0xF0, 0x55, 0xAA, 0x52, 0x08, 0x01}}},

+	{0x37, {LCM_SEND(2), {0x3, 0}}},

+};

+

+static LCM_Force_Cmd_Code rd_prep_code_1[]={

+	{0x37, {LCM_SEND(2), {0x1, 0}}},

+};

+static int32_t nt35516_mipi_init(struct panel_spec *self)

+{

+	int32_t i = 0;

+	LCM_Init_Code *init = init_data;

+	unsigned int tag;

+

+	mipi_set_cmd_mode_t mipi_set_cmd_mode = self->info.mipi->ops->mipi_set_cmd_mode;

+	mipi_gen_write_t mipi_gen_write = self->info.mipi->ops->mipi_gen_write;

+

+	pr_debug(KERN_DEBUG "nt35516_mipi_init\n");

+

+	mipi_set_cmd_mode();

+

+	for(i = 0; i < ARRAY_SIZE(init_data); i++){

+		tag = (init->tag >>24);

+		if(tag & LCM_TAG_SEND){

+			mipi_gen_write(init->data, (init->tag & LCM_TAG_MASK));

+			udelay(20);

+		}else if(tag & LCM_TAG_SLEEP){

+			msleep((init->tag & LCM_TAG_MASK));

+		}

+		init++;

+	}

+	return 0;

+}

+

+static uint32_t nt35516_readid(struct panel_spec *self)

+{

+	/*Jessica TODO: need read id*/

+	int32_t i = 0;

+	uint32_t j =0;

+	LCM_Force_Cmd_Code * rd_prepare = rd_prep_code;

+	uint8_t read_data[3] = {0};

+	int32_t read_rtn = 0;

+	unsigned int tag = 0;

+	mipi_set_cmd_mode_t mipi_set_cmd_mode = self->info.mipi->ops->mipi_set_cmd_mode;

+	mipi_force_write_t mipi_force_write = self->info.mipi->ops->mipi_force_write;

+	mipi_force_read_t mipi_force_read = self->info.mipi->ops->mipi_force_read;

+	mipi_eotp_set_t mipi_eotp_set = self->info.mipi->ops->mipi_eotp_set;

+

+	printk("lcd_nt35516_mipi read id!\n");

+

+	mipi_set_cmd_mode();

+	mipi_eotp_set(0,1);

+

+	for(j = 0; j < 4; j++){

+		rd_prepare = rd_prep_code;

+		for(i = 0; i < ARRAY_SIZE(rd_prep_code); i++){

+			tag = (rd_prepare->real_cmd_code.tag >> 24);

+			if(tag & LCM_TAG_SEND){

+				mipi_force_write(rd_prepare->datatype, rd_prepare->real_cmd_code.data, (rd_prepare->real_cmd_code.tag & LCM_TAG_MASK));

+			}else if(tag & LCM_TAG_SLEEP){

+				msleep((rd_prepare->real_cmd_code.tag & LCM_TAG_MASK));

+			}

+			rd_prepare++;

+		}

+		read_rtn = mipi_force_read(0xc5, 3,(uint8_t *)read_data);

+		printk("lcd_nt35516_mipi read id 0xc5 value is 0x%x, 0x%x, 0x%x!\n", read_data[0], read_data[1], read_data[2]);

+

+		if((0x55 == read_data[0])&&(0x16 == read_data[1])){

+			printk("lcd_nt35516_mipi read id success!\n");

+			mipi_eotp_set(1,1);

+			return 0x16;

+		}

+	}

+	mipi_eotp_set(1,1);

+	return 0x0;

+}

+

+static int32_t nt35516_enter_sleep(struct panel_spec *self, uint8_t is_sleep)

+{

+	int32_t i = 0;

+	LCM_Init_Code *sleep_in_out = NULL;

+	unsigned int tag;

+	int32_t size = 0;

+

+	mipi_gen_write_t mipi_gen_write = self->info.mipi->ops->mipi_gen_write;

+

+	printk(KERN_DEBUG "nt35516_enter_sleep, is_sleep = %d\n", is_sleep);

+

+	if(is_sleep){

+		sleep_in_out = sleep_in;

+		size = ARRAY_SIZE(sleep_in);

+	}else{

+		sleep_in_out = sleep_out;

+		size = ARRAY_SIZE(sleep_out);

+	}

+

+	for(i = 0; i <size ; i++){

+		tag = (sleep_in_out->tag >>24);

+		if(tag & LCM_TAG_SEND){

+			mipi_gen_write(sleep_in_out->data, (sleep_in_out->tag & LCM_TAG_MASK));

+		}else if(tag & LCM_TAG_SLEEP){

+			msleep((sleep_in_out->tag & LCM_TAG_MASK));

+		}

+		sleep_in_out++;

+	}

+	return 0;

+}

+

+static uint32_t nt35516_readpowermode(struct panel_spec *self)

+{

+	int32_t i = 0;

+	uint32_t j =0;

+	LCM_Force_Cmd_Code * rd_prepare = rd_prep_code_1;

+	uint8_t read_data[1] = {0};

+	int32_t read_rtn = 0;

+	unsigned int tag = 0;

+

+	mipi_force_write_t mipi_force_write = self->info.mipi->ops->mipi_force_write;

+	mipi_force_read_t mipi_force_read = self->info.mipi->ops->mipi_force_read;

+	mipi_eotp_set_t mipi_eotp_set = self->info.mipi->ops->mipi_eotp_set;

+

+	pr_debug("lcd_nt35516_mipi read power mode!\n");

+	mipi_eotp_set(0,1);

+	for(j = 0; j < 4; j++){

+		rd_prepare = rd_prep_code_1;

+		for(i = 0; i < ARRAY_SIZE(rd_prep_code_1); i++){

+			tag = (rd_prepare->real_cmd_code.tag >> 24);

+			if(tag & LCM_TAG_SEND){

+				mipi_force_write(rd_prepare->datatype, rd_prepare->real_cmd_code.data, (rd_prepare->real_cmd_code.tag & LCM_TAG_MASK));

+			}else if(tag & LCM_TAG_SLEEP){

+				msleep((rd_prepare->real_cmd_code.tag & LCM_TAG_MASK));

+			}

+			rd_prepare++;

+		}

+		read_rtn = mipi_force_read(0x0A, 1,(uint8_t *)read_data);

+		//printk("lcd_nt35516 mipi read power mode 0x0A value is 0x%x! , read result(%d)\n", read_data[0], read_rtn);

+		if((0x9c == read_data[0])  && (0 == read_rtn)){

+			pr_debug("lcd_nt35516_mipi read power mode success!\n");

+			mipi_eotp_set(1,1);

+			return 0x9c;

+		}

+	}

+

+	printk("lcd_nt35516 mipi read power mode fail!0x0A value is 0x%x! , read result(%d)\n", read_data[0], read_rtn);

+	mipi_eotp_set(1,1);

+	return 0x0;

+}

+

+static int32_t nt35516_check_esd(struct panel_spec *self)

+{

+	uint32_t power_mode;

+

+#ifndef FB_CHECK_ESD_IN_VFP

+	mipi_set_lp_mode_t mipi_set_data_lp_mode = self->info.mipi->ops->mipi_set_data_lp_mode;

+	mipi_set_hs_mode_t mipi_set_data_hs_mode = self->info.mipi->ops->mipi_set_data_hs_mode;

+	mipi_set_lp_mode_t mipi_set_lp_mode = self->info.mipi->ops->mipi_set_lp_mode;

+	mipi_set_hs_mode_t mipi_set_hs_mode = self->info.mipi->ops->mipi_set_hs_mode;

+	uint16_t work_mode = self->info.mipi->work_mode;

+#endif

+

+	pr_debug("nt35516_check_esd!\n");

+#ifndef FB_CHECK_ESD_IN_VFP

+	if(SPRDFB_MIPI_MODE_CMD==work_mode){

+		mipi_set_lp_mode();

+	}else{

+		mipi_set_data_lp_mode();

+	}

+#endif

+	power_mode = nt35516_readpowermode(self);

+	//power_mode = 0x0;

+#ifndef FB_CHECK_ESD_IN_VFP

+	if(SPRDFB_MIPI_MODE_CMD==work_mode){

+		mipi_set_hs_mode();

+	}else{

+		mipi_set_data_hs_mode();

+	}

+#endif

+	if(power_mode == 0x9c){

+		pr_debug("nt35516_check_esd OK!\n");

+		return 1;

+	}else{

+		printk("nt35516_check_esd fail!(0x%x)\n", power_mode);

+		return 0;

+	}

+}

+

+static struct panel_operations lcd_nt35516_mipi_operations = {

+	.panel_init = nt35516_mipi_init,

+	.panel_readid = nt35516_readid,

+	.panel_enter_sleep = nt35516_enter_sleep,

+	.panel_esd_check = nt35516_check_esd,

+};

+

+static struct timing_rgb lcd_nt35516_mipi_timing = {

+	.hfp = 20,  /* unit: pixel */

+	.hbp = 20,

+	.hsync = 20,//4,

+	.vfp = 10, /*unit: line*/

+	.vbp = 10,

+	.vsync = 6,

+};

+

+static struct info_mipi lcd_nt35516_mipi_info = {

+	.work_mode  = SPRDFB_MIPI_MODE_VIDEO,

+	.video_bus_width = 24, /*18,16*/

+	.lan_number = 3,

+	.phy_feq = 500*1000,

+	.h_sync_pol = SPRDFB_POLARITY_POS,

+	.v_sync_pol = SPRDFB_POLARITY_POS,

+	.de_pol = SPRDFB_POLARITY_POS,

+	.te_pol = SPRDFB_POLARITY_POS,

+	.color_mode_pol = SPRDFB_POLARITY_NEG,

+	.shut_down_pol = SPRDFB_POLARITY_NEG,

+	.timing = &lcd_nt35516_mipi_timing,

+	.ops = NULL,

+};

+

+struct panel_spec lcd_nt35516_mipi_spec = {

+	.width = 540,

+	.height = 960,

+	.fps = 60,

+	.type = LCD_MODE_DSI,

+	.direction = LCD_DIRECT_NORMAL,

+	.is_clean_lcd = true,

+	.info = {

+		.mipi = &lcd_nt35516_mipi_info

+	},

+	.ops = &lcd_nt35516_mipi_operations,

+};

+

+struct panel_cfg lcd_nt35516_mipi = {

+	/* this panel can only be main lcd */

+	.dev_id = SPRDFB_MAINLCD_ID,

+	.lcd_id = 0x16,

+	.lcd_name = "lcd_nt35516_mipi",

+	.panel = &lcd_nt35516_mipi_spec,

+};

+

+static int __init lcd_nt35516_mipi_init(void)

+{

+	return sprdfb_panel_register(&lcd_nt35516_mipi);

+}

+

+subsys_initcall(lcd_nt35516_mipi_init);