--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/src/cs/drivers/drv_app/r2d/lcds/E_Sample/r2d_task_init_i.c	Sun Jul 15 04:39:26 2018 +0000
@@ -0,0 +1,245 @@
+/* Used by refresh task to extract bytes from the
+framebuffer */
+
+#define __STANDARD_H__ /* Avoid to define UBYTE, SYS_UWORD16 and UINT32. */
+
+#include "r2d/lcds/e_sample/r2d_task_init_i.h"
+#include "r2d/lcds/e_sample/r2d_tfd_lcd.h"
+#include "r2d/r2d_i.h"
+#include "r2d/r2d_independance_layer.h"
+#include "r2d/r2d_env.h"
+
+const unsigned char INIT_DISCTL[DISCTL_PARAM_NBR] = { 0xDE,0x01,0x64,0x00,0x1B,0xF4,0x00,0xDC,0x00,0x02,0x00};
+
+const unsigned char INIT_GCP64[GCP64_PARAM_NBR] = {
+		0x15,0x00,0x29,0x00,0x3E,0x00,0x51,0x00,		0x65,0x00,0x7A,0x00,0x8D,0x00,0XA1,0x00,
+		0XB6,0x00,0XC7,0x00,0XD8,0x00,0XEB,0x00,		0XFB,0x00,0x0B,0x01,0X1B,0x01,0X27,0x01,
+		0x34,0x01,0x41,0x01,0x4C,0x01,0x55,0x01,		0x5F,0x01,0x68,0x01,0x70,0x01,0x78,0x01,
+		0x7E,0x01,0x86,0x01,0x8C,0x01,0x94,0x01,		0x9B,0x01,0XA1,0x01,0xA4,0x01,0xA9,0x01,
+		0xAD,0x01,0xB2,0x01,0xB7,0x01,0xBC,0x01,		0xC0,0x01,0xC4,0x01,0xC8,0x01,0xCB,0x01,
+		0xCF,0x01,0xD2,0x01,0xD5,0x01,0xD8,0x01,		0xDB,0x01,0xE0,0x01,0xE3,0x01,0xE6,0x01,
+		0xE8,0x01,0xEB,0x01,0xEE,0x01,0xF1,0x01,		0xF3,0x01,0xF8,0x01,0xF9,0x01,0xFC,0x01,
+		0x00,0x02,0x03,0x02,0x07,0x02,0x09,0x02,		0x0E,0x02,0x13,0x02,0x1C,0x02 };
+const unsigned char INIT_GCP16[GCP16_PARAM_NBR] = {
+	0x1A,0x31,0x48,0x54,0x5F,0x67,0x70,0x76,0x7C,0x80,0x83,0x84,0x85,0x87,0x96 };
+
+const unsigned char INIT_MD_PSET[MD_PSET_PARAM_NBR] = { 0x00, 0x01, 0x00, 0x01 };
+const unsigned char INIT_MD_CSET[MD_CSET_PARAM_NBR] = { 0x00, 0x02, 0x00, 0x02 };
+
+const unsigned char INIT_SD_PSET[SD_PSET_PARAM_NBR] = { 0, 0, 219, 0 };
+const unsigned char INIT_SD_CSET[SD_CSET_PARAM_NBR] = { 2, 0, 177, 0 };
+
+const unsigned char INIT_ASCSET[ASCSET_PARAM_NBR] = { 0x00, 0x00, 0xDB, 0x00, 0xDC, 0x00, 0x01 };
+const unsigned char INIT_SCSTART[SCSTART_PARAM_NBR] = { 0x00, 0x00 };
+
+
+extern T_RVF_MB_ID r2d_mb_id;
+
+
+static void r2d_nop_delay(SYS_UWORD32 ms)
+{
+    unsigned short a;
+    while (ms-- > 0) for (a=0;a<1000;a++) asm(" nop");
+}
+
+
+
+
+ void r2d_refresh_task_init(void)
+{
+
+#ifndef _WINDOWS
+
+  SYS_UWORD32  i,j,k;
+  SYS_UWORD16 command;
+  SYS_UWORD16 data;
+  SYS_UWORD16 tab_tmp[264];
+  SYS_UWORD16 *ptr;
+
+  command = LCD_DISNOR; /* LCD_activate */
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
+
+
+  command = LCD_DISOFF; // this command turns ON the full-screen display 
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
+
+
+  command = LCD_SLPIN; // this command causes the LCD module to enter the sleep mode 
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
+  
+
+  command = LCD_DISNOR; // this command turns the display mode to NORMAL 
+                        // without rewriting the content of the display data RAM 
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
+ 
+  r2d_nop_delay(10);
+
+  command = LCD_DATCTL;  // data mode of the MPU interface 
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
+  r2d_nop_delay(10);
+  data =  0x08;
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(data), 1, C_LCD_IF_DISPLAY);
+
+  r2d_nop_delay(10);
+
+  command = LCD_GSSET; // this command and the subsequent parameter make the grey scale mode 
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
+  r2d_nop_delay(10);
+  data = INIT_GSSET; // 64 gradients 
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(data), 1, C_LCD_IF_DISPLAY);
+
+
+  r2d_nop_delay(100);
+
+
+  command = LCD_DISCTL; // this command and the subsequent parameter make various display timing settings 
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
+
+  ptr = (SYS_UWORD16 *)&INIT_DISCTL[0];
+
+  f_lcd_if_poll_write(C_LCD_IF_CS0, ptr, 6, C_LCD_IF_DISPLAY);
+
+  r2d_nop_delay(100);
+
+
+  command = LCD_GCP64;  // Init palette for 64 gradient palette 
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
+
+  ptr = (SYS_UWORD16 *)&INIT_GCP64[0];
+  f_lcd_if_poll_write(C_LCD_IF_CS0, ptr, 63, C_LCD_IF_DISPLAY);
+
+  r2d_nop_delay(100);
+
+  command = LCD_GCP16;  // Init palette for 16 gradient palette 
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
+
+  ptr = (SYS_UWORD16 *)&INIT_GCP16[0];
+  f_lcd_if_poll_write(C_LCD_IF_CS0, ptr, 8, C_LCD_IF_DISPLAY);
+
+
+  command = LCD_MD_CSET;  // set area devoted to DSP interface 
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
+
+  ptr =  (SYS_UWORD16 *)&INIT_MD_CSET[0];
+  f_lcd_if_poll_write(C_LCD_IF_CS0, ptr, 2 , C_LCD_IF_DISPLAY);
+
+
+  command = LCD_MD_PSET;  // set area devoted to DSP interface 
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
+
+  ptr =  (SYS_UWORD16 *)&INIT_MD_PSET[0];
+  f_lcd_if_poll_write(C_LCD_IF_CS0, ptr, 2, C_LCD_IF_DISPLAY);
+
+
+  command = LCD_SD_CSET;  // set area devoted to MPU interface 
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
+
+  ptr =  (SYS_UWORD16 *)&INIT_SD_CSET[0];
+
+  f_lcd_if_poll_write(C_LCD_IF_CS0, ptr, 2, C_LCD_IF_DISPLAY);
+
+
+  command = LCD_SD_PSET;  // set area devoted to MPU interface
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
+
+  ptr =  (SYS_UWORD16 *)&INIT_SD_PSET[0];
+
+  f_lcd_if_poll_write(C_LCD_IF_CS0, ptr, 2, C_LCD_IF_DISPLAY);
+
+
+
+  command = LCD_OSCISEL;  // internal OSG 
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
+  data = INIT_OSCISEL; // 0x05 
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(data), 1, C_LCD_IF_DISPLAY);
+
+
+  command = LCD_14MSET; 
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
+  data = INIT_14MSET; // 0x4B 
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(data), 1, C_LCD_IF_DISPLAY);
+
+
+  command = LCD_14MEND;  
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
+
+
+  command = LCD_3500KSET; 
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
+  data = INIT_3500KSET; // 0x45 
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(data), 1, C_LCD_IF_DISPLAY);
+
+
+  command = LCD_3500KEND;
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
+
+
+  r2d_nop_delay(30);
+
+
+  command = LCD_SLPOUT; // this command cancels the sleep mode 
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
+
+
+  r2d_nop_delay(20);
+
+
+  command = LCD_VOLCTL;  // sets Ton timing of power IC 
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
+  data = INIT_VOLCTL_Ton; // 152 
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(data), 1, C_LCD_IF_DISPLAY);
+
+
+  r2d_nop_delay(20);
+
+
+  command = LCD_VOLCTL;  // sets the electronic volume 
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
+  data = INIT_VOLCTL;
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(data), 1, C_LCD_IF_DISPLAY);
+
+
+  r2d_nop_delay(20);
+
+  
+  command = LCD_DISON; 
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
+
+  command = LCD_DISNOR; // this command turns the display mode to NORMAL 
+                        // without rewriting the content of the display data RAM 
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
+
+  command = LCD_RAMWR; 
+  f_lcd_if_poll_write(C_LCD_IF_CS0, &(command), 1, C_LCD_IF_INSTRUCTION);
+
+
+  for (i=0; i<264; i++)
+  {
+    // Try filling with white color 
+    tab_tmp[i] = 0xFFFF;
+  }
+  
+  for(j=0; j<220; j++)
+  {
+	f_lcd_if_poll_write(C_LCD_IF_CS0, &(tab_tmp[0]), 264, C_LCD_IF_DISPLAY);
+  }
+
+#endif
+}
+
+void r2d_refresh_task_kill(void)
+{
+}
+
+
+void r2d_dithering_init(void)
+{
+   R2D_MALLOC(r2d_mb_id,UINT32,sizeof(UINT32)*4,r2d_g_dithering_matrix);
+   if (r2d_g_dithering_matrix!=NULL)
+   {
+     r2d_g_dithering_matrix[0]=0;
+     r2d_g_dithering_matrix[1]=2;
+     r2d_g_dithering_matrix[2]=3;
+     r2d_g_dithering_matrix[3]=1;
+   }
+}