nt35510_dsi_cmd_6572.c 16 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622
  1. /* Copyright Statement:
  2. *
  3. * This software/firmware and related documentation ("MediaTek Software") are
  4. * protected under relevant copyright laws. The information contained herein
  5. * is confidential and proprietary to MediaTek Inc. and/or its licensors.
  6. * Without the prior written permission of MediaTek inc. and/or its licensors,
  7. * any reproduction, modification, use or disclosure of MediaTek Software,
  8. * and information contained herein, in whole or in part, shall be strictly prohibited.
  9. */
  10. /* MediaTek Inc. (C) 2015. All rights reserved.
  11. *
  12. * BY OPENING THIS FILE, RECEIVER HEREBY UNEQUIVOCALLY ACKNOWLEDGES AND AGREES
  13. * THAT THE SOFTWARE/FIRMWARE AND ITS DOCUMENTATIONS ("MEDIATEK SOFTWARE")
  14. * RECEIVED FROM MEDIATEK AND/OR ITS REPRESENTATIVES ARE PROVIDED TO RECEIVER ON
  15. * AN "AS-IS" BASIS ONLY. MEDIATEK EXPRESSLY DISCLAIMS ANY AND ALL WARRANTIES,
  16. * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE IMPLIED WARRANTIES OF
  17. * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE OR NONINFRINGEMENT.
  18. * NEITHER DOES MEDIATEK PROVIDE ANY WARRANTY WHATSOEVER WITH RESPECT TO THE
  19. * SOFTWARE OF ANY THIRD PARTY WHICH MAY BE USED BY, INCORPORATED IN, OR
  20. * SUPPLIED WITH THE MEDIATEK SOFTWARE, AND RECEIVER AGREES TO LOOK ONLY TO SUCH
  21. * THIRD PARTY FOR ANY WARRANTY CLAIM RELATING THERETO. RECEIVER EXPRESSLY ACKNOWLEDGES
  22. * THAT IT IS RECEIVER'S SOLE RESPONSIBILITY TO OBTAIN FROM ANY THIRD PARTY ALL PROPER LICENSES
  23. * CONTAINED IN MEDIATEK SOFTWARE. MEDIATEK SHALL ALSO NOT BE RESPONSIBLE FOR ANY MEDIATEK
  24. * SOFTWARE RELEASES MADE TO RECEIVER'S SPECIFICATION OR TO CONFORM TO A PARTICULAR
  25. * STANDARD OR OPEN FORUM. RECEIVER'S SOLE AND EXCLUSIVE REMEDY AND MEDIATEK'S ENTIRE AND
  26. * CUMULATIVE LIABILITY WITH RESPECT TO THE MEDIATEK SOFTWARE RELEASED HEREUNDER WILL BE,
  27. * AT MEDIATEK'S OPTION, TO REVISE OR REPLACE THE MEDIATEK SOFTWARE AT ISSUE,
  28. * OR REFUND ANY SOFTWARE LICENSE FEES OR SERVICE CHARGE PAID BY RECEIVER TO
  29. * MEDIATEK FOR SUCH MEDIATEK SOFTWARE AT ISSUE.
  30. */
  31. #ifdef BUILD_LK
  32. #include <string.h>
  33. #else
  34. #include <linux/string.h>
  35. #if defined(BUILD_UBOOT)
  36. #include <asm/arch/mt_gpio.h>
  37. #else
  38. #include <mach/mt_gpio.h>
  39. #endif
  40. #endif
  41. #include "lcm_drv.h"
  42. #if defined(BUILD_LK)
  43. #define LCM_PRINT printf
  44. #elif defined(BUILD_UBOOT)
  45. #define LCM_PRINT printf
  46. #else
  47. #define LCM_PRINT printk
  48. #endif
  49. // ---------------------------------------------------------------------------
  50. // Local Constants
  51. // ---------------------------------------------------------------------------
  52. #define FRAME_WIDTH (480) // pixel
  53. #define FRAME_HEIGHT (800) // pixel
  54. #define PHYSICAL_WIDTH (56) // mm
  55. #define PHYSICAL_HEIGHT (93) // mm
  56. #define REGFLAG_DELAY 0xAB
  57. #define REGFLAG_END_OF_TABLE 0xAA // END OF REGISTERS MARKER
  58. // ---------------------------------------------------------------------------
  59. // Local Variables
  60. // ---------------------------------------------------------------------------
  61. static LCM_UTIL_FUNCS lcm_util;
  62. #define SET_RESET_PIN(v) (lcm_util.set_reset_pin((v)))
  63. #define UDELAY(n) (lcm_util.udelay(n))
  64. #define MDELAY(n) (lcm_util.mdelay(n))
  65. #define LCM_ID (0x55)
  66. #define LCM_ID1 (0xBC)
  67. #define LCM_ID2 (0xc0)
  68. // ---------------------------------------------------------------------------
  69. // Local Functions
  70. // ---------------------------------------------------------------------------
  71. #define dsi_set_cmdq_V2(cmd, count, ppara, force_update) lcm_util.dsi_set_cmdq_V2(cmd, count, ppara, force_update)
  72. #define dsi_set_cmdq(pdata, queue_size, force_update) lcm_util.dsi_set_cmdq(pdata, queue_size, force_update)
  73. #define wrtie_cmd(cmd) lcm_util.dsi_write_cmd(cmd)
  74. #define write_regs(addr, pdata, byte_nums) lcm_util.dsi_write_regs(addr, pdata, byte_nums)
  75. #define read_reg(cmd) lcm_util.dsi_dcs_read_lcm_reg(cmd)
  76. #define read_reg_v2(cmd, buffer, buffer_size) lcm_util.dsi_dcs_read_lcm_reg_v2(cmd, buffer, buffer_size)
  77. struct LCM_setting_table {
  78. unsigned char cmd;
  79. unsigned char count;
  80. unsigned char para_list[64];
  81. };
  82. #if 0
  83. static struct LCM_setting_table lcm_sleep_out_setting[] = {
  84. // Sleep Out
  85. {0x11, 1, {0x00}},
  86. {REGFLAG_DELAY, 120, {}},
  87. // Display ON
  88. {0x29, 1, {0x00}},
  89. {REGFLAG_END_OF_TABLE, 0x00, {}}
  90. };
  91. static struct LCM_setting_table lcm_deep_sleep_mode_in_setting[] = {
  92. // Display off sequence
  93. {0x28, 1, {0x00}},
  94. {REGFLAG_DELAY, 10, {}},
  95. // Sleep Mode On
  96. {0x10, 1, {0x00}},
  97. {REGFLAG_DELAY, 120, {}},
  98. {REGFLAG_END_OF_TABLE, 0x00, {}}
  99. };
  100. static void push_table(struct LCM_setting_table *table, unsigned int count, unsigned char force_update)
  101. {
  102. unsigned int i;
  103. for (i = 0; i < count; i++) {
  104. unsigned cmd;
  105. cmd = table[i].cmd;
  106. switch (cmd) {
  107. case REGFLAG_DELAY:
  108. MDELAY(table[i].count);
  109. break;
  110. case REGFLAG_END_OF_TABLE:
  111. break;
  112. default:
  113. dsi_set_cmdq_V2(cmd, table[i].count, table[i].para_list, force_update);
  114. if (cmd != 0xFF && cmd != 0x2C && cmd != 0x3C) {
  115. //#if defined(BUILD_UBOOT)
  116. // printf("[DISP] - uboot - REG_R(0x%x) = 0x%x. \n", cmd, table[i].para_list[0]);
  117. //#endif
  118. while (read_reg(cmd) != table[i].para_list[0]);
  119. }
  120. }
  121. }
  122. }
  123. #endif
  124. // ---------------------------------------------------------------------------
  125. // LCM Driver Implementations
  126. // ---------------------------------------------------------------------------
  127. static void lcm_set_util_funcs(const LCM_UTIL_FUNCS * util)
  128. {
  129. memcpy(&lcm_util, util, sizeof(LCM_UTIL_FUNCS));
  130. }
  131. static void lcm_get_params(LCM_PARAMS * params)
  132. {
  133. memset(params, 0, sizeof(LCM_PARAMS));
  134. params->type = LCM_TYPE_DSI;
  135. params->width = FRAME_WIDTH;
  136. params->height = FRAME_HEIGHT;
  137. // physical size
  138. params->physical_width = PHYSICAL_WIDTH;
  139. params->physical_height = PHYSICAL_HEIGHT;
  140. // enable tearing-free
  141. params->dbi.te_mode = LCM_DBI_TE_MODE_DISABLED;
  142. params->dbi.te_edge_polarity = LCM_POLARITY_RISING;
  143. params->dsi.mode = CMD_MODE;
  144. // DSI
  145. /* Command mode setting */
  146. params->dsi.LANE_NUM = LCM_TWO_LANE;
  147. //The following defined the fomat for data coming from LCD engine.
  148. params->dsi.data_format.color_order = LCM_COLOR_ORDER_RGB;
  149. params->dsi.data_format.trans_seq = LCM_DSI_TRANS_SEQ_MSB_FIRST;
  150. params->dsi.data_format.padding = LCM_DSI_PADDING_ON_LSB;
  151. params->dsi.data_format.format = LCM_DSI_FORMAT_RGB888;
  152. params->dsi.intermediat_buffer_num = 0; //because DSI/DPI HW design change, this parameters should be 0 when video mode in MT658X; or memory leakage
  153. params->dsi.PS = LCM_PACKED_PS_24BIT_RGB888;
  154. params->dsi.word_count = 480 * 3; //DSI CMD mode need set these two bellow params, different to 6577
  155. params->dsi.vertical_active_line = 800;
  156. params->dsi.compatibility_for_nvk = 0; // this parameter would be set to 1 if DriverIC is NTK's and when force match DSI clock for NTK's
  157. // Bit rate calculation
  158. params->dsi.PLL_CLOCK = 221; //dsi clock customization: should config clock value directly
  159. }
  160. static void init_lcm_registers(void)
  161. {
  162. unsigned int data_array[16];
  163. //*************Enable TE *******************//
  164. data_array[0]= 0x00053902;
  165. data_array[1]= 0x2555aaff;
  166. data_array[2]= 0x00000001;
  167. dsi_set_cmdq(data_array, 3, 1);
  168. data_array[0]= 0x00093902;
  169. data_array[1]= 0x000201f8;
  170. data_array[2]= 0x00133320;
  171. data_array[3]= 0x00000048;
  172. dsi_set_cmdq(data_array, 4, 1);
  173. //*************Enable CMD2 Page1 *******************//
  174. data_array[0]=0x00063902;
  175. data_array[1]=0x52aa55f0;
  176. data_array[2]=0x00000108;
  177. dsi_set_cmdq(data_array, 3, 1);
  178. //************* AVDD: manual *******************//
  179. data_array[0]=0x00043902;
  180. data_array[1]=0x0d0d0db0;
  181. dsi_set_cmdq(data_array, 2, 1);
  182. data_array[0]=0x00043902;
  183. data_array[1]=0x343434b6;
  184. dsi_set_cmdq(data_array, 2, 1);
  185. data_array[0]=0x00043902;
  186. data_array[1]=0x0d0d0db1;
  187. dsi_set_cmdq(data_array, 2, 1);
  188. data_array[0]=0x00043902;
  189. data_array[1]=0x343434b7;
  190. dsi_set_cmdq(data_array, 2, 1);
  191. data_array[0]=0x00043902;
  192. data_array[1]=0x000000b2;
  193. dsi_set_cmdq(data_array, 2, 1);
  194. data_array[0]=0x00043902;
  195. data_array[1]=0x242424b8;
  196. dsi_set_cmdq(data_array, 2, 1);
  197. data_array[0]=0x00023902;
  198. data_array[1]=0x000001bf;
  199. dsi_set_cmdq(data_array, 2, 1);
  200. data_array[0]=0x00043902;
  201. data_array[1]=0x0f0f0fb3;
  202. dsi_set_cmdq(data_array, 2, 1);
  203. data_array[0]=0x00043902;
  204. data_array[1]=0x343434b9;
  205. dsi_set_cmdq(data_array, 2, 1);
  206. data_array[0]=0x00043902;
  207. data_array[1]=0x080808b5;
  208. dsi_set_cmdq(data_array, 2, 1);
  209. data_array[0]=0x00023902;
  210. data_array[1]=0x000003c2;
  211. dsi_set_cmdq(data_array, 2, 1);
  212. data_array[0]=0x00043902;
  213. data_array[1]=0x242424ba;
  214. dsi_set_cmdq(data_array, 2, 1);
  215. data_array[0]=0x00043902;
  216. data_array[1]=0x007800bc;
  217. dsi_set_cmdq(data_array, 2, 1);
  218. data_array[0]=0x00043902;
  219. data_array[1]=0x007800bd;
  220. dsi_set_cmdq(data_array, 2, 1);
  221. data_array[0]=0x00033902;
  222. data_array[1]=0x006400be;
  223. dsi_set_cmdq(data_array, 2, 1);
  224. //*************Gamma Table *******************//
  225. data_array[0]=0x00353902;
  226. data_array[1]=0x003300D1;
  227. data_array[2]=0x003A0034;
  228. data_array[3]=0x005C004A;
  229. data_array[4]=0x00A60081;
  230. data_array[5]=0x011301E5;
  231. data_array[6]=0x01820154;
  232. data_array[7]=0x020002CA;
  233. data_array[8]=0x02340201;
  234. data_array[9]=0x02840267;
  235. data_array[10]=0x02B702A4;
  236. data_array[11]=0x02DE02CF;
  237. data_array[12]=0x03FE02F2;
  238. data_array[13]=0x03330310;
  239. data_array[14]=0x0000006D;
  240. dsi_set_cmdq(data_array, 15, 1);
  241. data_array[0]=0x00353902;
  242. data_array[1]=0x003300D2;
  243. data_array[2]=0x003A0034;
  244. data_array[3]=0x005C004A;
  245. data_array[4]=0x00A60081;
  246. data_array[5]=0x011301E5;
  247. data_array[6]=0x01820154;
  248. data_array[7]=0x020002CA;
  249. data_array[8]=0x02340201;
  250. data_array[9]=0x02840267;
  251. data_array[10]=0x02B702A4;
  252. data_array[11]=0x02DE02CF;
  253. data_array[12]=0x03FE02F2;
  254. data_array[13]=0x03330310;
  255. data_array[14]=0x0000006D;
  256. dsi_set_cmdq(data_array, 15, 1);
  257. data_array[0]=0x00353902;
  258. data_array[1]=0x003300D3;
  259. data_array[2]=0x003A0034;
  260. data_array[3]=0x005C004A;
  261. data_array[4]=0x00A60081;
  262. data_array[5]=0x011301E5;
  263. data_array[6]=0x01820154;
  264. data_array[7]=0x020002CA;
  265. data_array[8]=0x02340201;
  266. data_array[9]=0x02840267;
  267. data_array[10]=0x02B702A4;
  268. data_array[11]=0x02DE02CF;
  269. data_array[12]=0x03FE02F2;
  270. data_array[13]=0x03330310;
  271. data_array[14]=0x0000006D;
  272. dsi_set_cmdq(data_array, 15, 1);
  273. data_array[0]=0x00353902;
  274. data_array[1]=0x003300D4;
  275. data_array[2]=0x003A0034;
  276. data_array[3]=0x005C004A;
  277. data_array[4]=0x00A60081;
  278. data_array[5]=0x011301E5;
  279. data_array[6]=0x01820154;
  280. data_array[7]=0x020002CA;
  281. data_array[8]=0x02340201;
  282. data_array[9]=0x02840267;
  283. data_array[10]=0x02B702A4;
  284. data_array[11]=0x02DE02CF;
  285. data_array[12]=0x03FE02F2;
  286. data_array[13]=0x03330310;
  287. data_array[14]=0x0000006D;
  288. dsi_set_cmdq(data_array, 15, 1);
  289. data_array[0]=0x00353902;
  290. data_array[1]=0x003300D5;
  291. data_array[2]=0x003A0034;
  292. data_array[3]=0x005C004A;
  293. data_array[4]=0x00A60081;
  294. data_array[5]=0x011301E5;
  295. data_array[6]=0x01820154;
  296. data_array[7]=0x020002CA;
  297. data_array[8]=0x02340201;
  298. data_array[9]=0x02840267;
  299. data_array[10]=0x02B702A4;
  300. data_array[11]=0x02DE02CF;
  301. data_array[12]=0x03FE02F2;
  302. data_array[13]=0x03330310;
  303. data_array[14]=0x0000006D;
  304. dsi_set_cmdq(data_array, 15, 1);
  305. data_array[0]=0x00353902;
  306. data_array[1]=0x003300D6;
  307. data_array[2]=0x003A0034;
  308. data_array[3]=0x005C004A;
  309. data_array[4]=0x00A60081;
  310. data_array[5]=0x011301E5;
  311. data_array[6]=0x01820154;
  312. data_array[7]=0x020002CA;
  313. data_array[8]=0x02340201;
  314. data_array[9]=0x02840267;
  315. data_array[10]=0x02B702A4;
  316. data_array[11]=0x02DE02CF;
  317. data_array[12]=0x03FE02F2;
  318. data_array[13]=0x03330310;
  319. data_array[14]=0x0000006D;
  320. dsi_set_cmdq(data_array, 15, 1);
  321. MDELAY(10);
  322. // ******************** EABLE CMD2 PAGE 0 **************//
  323. data_array[0]=0x00063902;
  324. data_array[1]=0x52aa55f0;
  325. data_array[2]=0x00000008;
  326. dsi_set_cmdq(data_array, 3, 1);
  327. // ******************** EABLE DSI TE **************//
  328. data_array[0]=0x00033902;
  329. data_array[1]=0x0000fcb1;
  330. dsi_set_cmdq(data_array, 2, 1);
  331. data_array[0]=0x00023902;
  332. data_array[1]=0x000005b6;
  333. dsi_set_cmdq(data_array, 2, 1);
  334. data_array[0]=0x00033902;
  335. data_array[1]=0x007070b7;
  336. dsi_set_cmdq(data_array, 2, 1);
  337. data_array[0]=0x00053902;
  338. data_array[1]=0x030301b8;
  339. data_array[2]=0x00000003;
  340. dsi_set_cmdq(data_array, 3, 1);
  341. data_array[0]=0x00043902;
  342. data_array[1]=0x000002bc;
  343. dsi_set_cmdq(data_array, 2, 1);
  344. data_array[0]=0x00063902;
  345. data_array[1]=0x5002d0c9;
  346. data_array[2]=0x00005050;
  347. dsi_set_cmdq(data_array, 3, 1);
  348. // ******************** EABLE DSI TE packet **************//
  349. data_array[0]=0x00351500;
  350. dsi_set_cmdq(data_array, 1, 1);
  351. data_array[0]=0x773a1500;
  352. dsi_set_cmdq(data_array, 1, 1);
  353. data_array[0]= 0x00053902;
  354. data_array[1]= 0x0100002a;
  355. data_array[2]= 0x000000df;
  356. dsi_set_cmdq(data_array, 3, 1);
  357. data_array[0]= 0x00053902;
  358. data_array[1]= 0x0300002b;
  359. data_array[2]= 0x0000001f;
  360. dsi_set_cmdq(data_array, 3, 1);
  361. data_array[0] = 0x00110500;
  362. dsi_set_cmdq(data_array, 1, 1);
  363. MDELAY(120);
  364. data_array[0]= 0x00290500;
  365. dsi_set_cmdq(data_array, 1, 1);
  366. }
  367. static void lcm_init(void)
  368. {
  369. SET_RESET_PIN(1);
  370. SET_RESET_PIN(0);
  371. MDELAY(5);
  372. SET_RESET_PIN(1);
  373. MDELAY(20);
  374. init_lcm_registers();
  375. }
  376. static void lcm_suspend(void)
  377. {
  378. unsigned int data_array[16];
  379. data_array[0] = 0x00100500;
  380. dsi_set_cmdq(data_array, 1, 1);
  381. MDELAY(120);
  382. data_array[0] = 0x00280500;
  383. dsi_set_cmdq(data_array, 1, 1);
  384. MDELAY(10);
  385. data_array[0] = 0x014F1500;
  386. dsi_set_cmdq(data_array, 1, 1);
  387. MDELAY(40);
  388. }
  389. static void lcm_resume(void)
  390. {
  391. lcm_init();
  392. }
  393. static void lcm_update(unsigned int x, unsigned int y, unsigned int width, unsigned int height)
  394. {
  395. unsigned int x0 = x;
  396. unsigned int y0 = y;
  397. unsigned int x1 = x0 + width - 1;
  398. unsigned int y1 = y0 + height - 1;
  399. unsigned char x0_MSB = ((x0 >> 8) & 0xFF);
  400. unsigned char x0_LSB = (x0 & 0xFF);
  401. unsigned char x1_MSB = ((x1 >> 8) & 0xFF);
  402. unsigned char x1_LSB = (x1 & 0xFF);
  403. unsigned char y0_MSB = ((y0 >> 8) & 0xFF);
  404. unsigned char y0_LSB = (y0 & 0xFF);
  405. unsigned char y1_MSB = ((y1 >> 8) & 0xFF);
  406. unsigned char y1_LSB = (y1 & 0xFF);
  407. unsigned int data_array[16];
  408. data_array[0] = 0x00053902;
  409. data_array[1] = (x1_MSB << 24) | (x0_LSB << 16) | (x0_MSB << 8) | 0x2a;
  410. data_array[2] = (x1_LSB);
  411. dsi_set_cmdq(data_array, 3, 1);
  412. data_array[0] = 0x00053902;
  413. data_array[1] = (y1_MSB << 24) | (y0_LSB << 16) | (y0_MSB << 8) | 0x2b;
  414. data_array[2] = (y1_LSB);
  415. dsi_set_cmdq(data_array, 3, 1);
  416. data_array[0] = 0x002c3909;
  417. dsi_set_cmdq(data_array, 1, 0);
  418. }
  419. static void lcm_setbacklight(unsigned int level)
  420. {
  421. unsigned int data_array[16];
  422. if (level > 255)
  423. level = 255;
  424. data_array[0] = 0x00023902;
  425. data_array[1] = (0x51 | (level << 8));
  426. dsi_set_cmdq(data_array, 2, 1);
  427. }
  428. #if 0
  429. static void lcm_setpwm(unsigned int divider)
  430. {
  431. // TBD
  432. }
  433. static unsigned int lcm_getpwm(unsigned int divider)
  434. {
  435. // ref freq = 15MHz, B0h setting 0x80, so 80.6% * freq is pwm_clk;
  436. // pwm_clk / 255 / 2(lcm_setpwm() 6th params) = pwm_duration = 23706
  437. unsigned int pwm_clk = 23706 / (1 << divider);
  438. return pwm_clk;
  439. }
  440. #endif
  441. static unsigned int lcm_compare_id(void)
  442. {
  443. unsigned int id = 0;
  444. unsigned char buffer[2];
  445. unsigned int data_array[16];
  446. SET_RESET_PIN(1); //NOTE:should reset LCM firstly
  447. MDELAY(10);
  448. SET_RESET_PIN(0);
  449. MDELAY(10);
  450. SET_RESET_PIN(1);
  451. MDELAY(10);
  452. /*
  453. data_array[0] = 0x00110500; // Sleep Out
  454. dsi_set_cmdq(data_array, 1, 1);
  455. MDELAY(120);
  456. */
  457. //*************Enable CMD2 Page1 *******************//
  458. data_array[0] = 0x00063902;
  459. data_array[1] = 0x52AA55F0;
  460. data_array[2] = 0x00000108;
  461. dsi_set_cmdq(data_array, 3, 1);
  462. MDELAY(10);
  463. data_array[0] = 0x00023700; // read id return two byte,version and id
  464. dsi_set_cmdq(data_array, 1, 1);
  465. MDELAY(10);
  466. read_reg_v2(0xC5, buffer, 2);
  467. id = buffer[0]; //we only need ID
  468. return (LCM_ID == id) ? 1 : 0;
  469. }
  470. void lcm_read_fb(unsigned char *buffer)
  471. {
  472. unsigned int array[2];
  473. array[0] = 0x000A3700;// read size
  474. dsi_set_cmdq(array, 1, 1);
  475. read_reg_v2(0x2E,buffer,10);
  476. read_reg_v2(0x3E,buffer+10,10);
  477. read_reg_v2(0x3E,buffer+10*2,10);
  478. read_reg_v2(0x3E,buffer+10*3,10);
  479. read_reg_v2(0x3E,buffer+10*4,10);
  480. read_reg_v2(0x3E,buffer+10*5,10);
  481. }
  482. // ---------------------------------------------------------------------------
  483. // Get LCM Driver Hooks
  484. // ---------------------------------------------------------------------------
  485. LCM_DRIVER nt35510_dsi_cmd_6572_drv = {
  486. .name = "nt35510_dsi_cmd_6572",
  487. .set_util_funcs = lcm_set_util_funcs,
  488. .get_params = lcm_get_params,
  489. .init = lcm_init,
  490. .suspend = lcm_suspend,
  491. .resume = lcm_resume,
  492. .set_backlight = lcm_setbacklight,
  493. //.set_pwm = lcm_setpwm,
  494. //.get_pwm = lcm_getpwm,
  495. .compare_id = lcm_compare_id,
  496. .update = lcm_update,
  497. .read_fb = lcm_read_fb,
  498. };