Landtiger (LPC1768) graphics LCD demo.

Dependencies:   mbed

Revision:
3:2dccfa0121de
Parent:
2:43ede88fb5a3
Child:
4:cdeea87f25d8
--- a/GLCD_LPC1700.cpp	Tue Nov 06 21:39:33 2012 +0000
+++ b/GLCD_LPC1700.cpp	Fri Oct 30 01:26:40 2015 +0000
@@ -1,5 +1,5 @@
 /******************************************************************************/
-/* GLCD::LPC1700 low-level Graphic LCD (320x240 pixels) for LandTiger          */
+/* GLCD::LPC1700 low-level Graphic LCD (320x240 pixels) for LandTiger         */
 /*                                                                            */
 /******************************************************************************/
 /* This file is modified from the uVision/ARM development tools.              */
@@ -67,15 +67,14 @@
 /* Pin RD setting to 0 or 1                                                   */
 #define LCD_RD(x)   ((x) ? (LPC_GPIO0->FIOSET = PIN_RD) : (LPC_GPIO0->FIOCLR = PIN_RD));
 
- 
-/*---------------------------- Global variables ------------------------------*/
-
-/******************************************************************************/
-//static volatile unsigned short ____textColor = Black, _______backColor = White;
-//static unsigned short ___driverCode;
 
 /************************ Local auxiliary functions ***************************/
 
+#define MAX_POLY_CORNERS   200
+#define POLY_Y(Z)          ((int32_t)((Points + Z)->X))
+#define POLY_X(Z)          ((int32_t)((Points + Z)->Y))
+#define ABS(X)  ((X) > 0 ? (X) : -(X)) 
+
 #define swap(type, i, j) {type t = i; i = j; j = t;}
 
 // rrrrrggggggbbbbb
@@ -107,7 +106,7 @@
 
 
 GLCD::GLCD() {
-  Init();
+  init();
 }
 
 
@@ -117,7 +116,7 @@
 *   Return:                                                                    *
 *******************************************************************************/
 
-unsigned char GLCD::lcd_send (unsigned short data) {
+uint8_t GLCD::_lcd_send (uint16_t data) {
 
   LPC_GPIO2->FIODIR |= 0x000000ff;  //P2.0...P2.7 Output
   LCD_DIR(1)                           //Interface A->B
@@ -136,8 +135,8 @@
 *   Return: short data from LCD                                                *
 *******************************************************************************/
 
-unsigned short GLCD::lcd_read (void) {
-  unsigned short id;
+uint16_t GLCD::_lcd_read (void) {
+  uint16_t id;
   LPC_GPIO2->FIODIR &= 0xffffff00;                //P2.0...P2.7 Input
   LCD_DIR(0)                                         //Interface B->A
   LCD_EN(0)                                          //Enable 2B->2A
@@ -156,11 +155,11 @@
 *   Return:                                                                    *
 *******************************************************************************/
 
-void GLCD::wr_cmd (unsigned char c) {
+void GLCD::_wr_cmd (uint16_t c) {
 
   LCD_RS(0)
   LCD_RD(1)
-  lcd_send(c);
+  _lcd_send(c);
   LCD_WR(0)
   wait();
   LCD_WR(1)
@@ -173,11 +172,11 @@
 *   Return:                                                                    *
 *******************************************************************************/
 
-void GLCD::wr_dat (unsigned short c) {
+void GLCD::_wr_dat (uint16_t c) {
 
   LCD_RS(1)
   LCD_RD(1)
-  lcd_send(c);
+  _lcd_send(c);
   LCD_WR(0)
   wait();
   LCD_WR(1)
@@ -189,13 +188,13 @@
 *   Return:               read data                                            *
 *******************************************************************************/
 
-unsigned short GLCD::rd_dat (void) {
-  unsigned short val = 0;
+uint16_t GLCD::_rd_dat (void) {
+  uint16_t val = 0;
 
   LCD_RS(1)
   LCD_WR(1)
   LCD_RD(0)
-  val = lcd_read();
+  val = _lcd_read();
   LCD_RD(1)
   return val;
 }
@@ -206,7 +205,7 @@
 *   Return:                                                                    *
 *******************************************************************************/
 
-void GLCD::wr_dat_start (void) {
+void GLCD::_wr_dat_start (void) {
 
   LCD_CS(0)  
   LCD_RS(1)
@@ -219,7 +218,7 @@
 *   Return:                                                                    *
 *******************************************************************************/
 
-void GLCD::wr_dat_stop (void) {
+void GLCD::_wr_dat_stop (void) {
 
   LCD_CS(1)
 }
@@ -231,9 +230,9 @@
 *   Return:                                                                    *
 *******************************************************************************/
 
-void GLCD::wr_dat_only (unsigned short c) {
+void GLCD::_wr_dat_only (uint16_t c) {
 
-  lcd_send(c);
+  _lcd_send(c);
   LCD_WR(0)
   wait();
   LCD_WR(1)
@@ -246,11 +245,11 @@
 *                 val:    value to write to register                           *
 *******************************************************************************/
 
-void GLCD::wr_reg (unsigned char reg, unsigned short val) {
+void GLCD::_wr_reg (uint16_t reg, uint16_t val) {
 
   LCD_CS(0)
-  wr_cmd(reg);
-  wr_dat(val);
+  _wr_cmd(reg);
+  _wr_dat(val);
   LCD_CS(1)
 }
 
@@ -261,12 +260,12 @@
 *   Return:               value read from register                             *
 *******************************************************************************/
 
-unsigned short GLCD::rd_reg (unsigned short reg) {
-  unsigned short val = 0;
+uint16_t GLCD::_rd_reg (uint16_t reg) {
+  uint16_t val = 0;
 
   LCD_CS(0)
-  wr_cmd(reg);
-  val = rd_dat(); 
+  _wr_cmd(reg);
+  val = _rd_dat(); 
   LCD_CS(1)
   return (val);
 }
@@ -280,7 +279,7 @@
 *   Return:                                                                    *
 *******************************************************************************/
 
-void GLCD::Init (void) { 
+void GLCD::init (void) { 
 
   /* Configure the LCD Control pins                                           */
   LPC_GPIO0->FIODIR   |= 0x03f80000;
@@ -288,51 +287,51 @@
 
   delay(5);                             /* Delay 50 ms                        */
 
-  _driverCode = rd_reg(0x00);
+  _driverCode = _rd_reg(0x00);
 
   switch (_driverCode) {
 
     case LGDP4531_ID:  {      //2.8" TFT LCD Module, DriverIC is LGDP4531
 
 #ifndef DISABLE_LGDP4531
-      wr_reg(0x00,0x0001);
-      wr_reg(0x10,0x0628);
-      wr_reg(0x12,0x0006);
-      wr_reg(0x13,0x0A32);
-      wr_reg(0x11,0x0040);
-      wr_reg(0x15,0x0050);
-      wr_reg(0x12,0x0016);
+      _wr_reg(0x00,0x0001);
+      _wr_reg(0x10,0x0628);
+      _wr_reg(0x12,0x0006);
+      _wr_reg(0x13,0x0A32);
+      _wr_reg(0x11,0x0040);
+      _wr_reg(0x15,0x0050);
+      _wr_reg(0x12,0x0016);
       delay(15);
-      wr_reg(0x10,0x5660);
+      _wr_reg(0x10,0x5660);
       delay(15);
-      wr_reg(0x13,0x2A4E);
-      wr_reg(0x01,0x0100);
-      wr_reg(0x02,0x0300);
+      _wr_reg(0x13,0x2A4E);
+      _wr_reg(0x01,0x0100);
+      _wr_reg(0x02,0x0300);
     
-      wr_reg(0x03,0x1030);
+      _wr_reg(0x03,0x1030);
     
-      wr_reg(0x08,0x0202);
-      wr_reg(0x0A,0x0000);
-      wr_reg(0x30,0x0000);
-      wr_reg(0x31,0x0402);
-      wr_reg(0x32,0x0106);
-      wr_reg(0x33,0x0700);
-      wr_reg(0x34,0x0104);
-      wr_reg(0x35,0x0301);
-      wr_reg(0x36,0x0707);
-      wr_reg(0x37,0x0305);
-      wr_reg(0x38,0x0208);
-      wr_reg(0x39,0x0F0B);
+      _wr_reg(0x08,0x0202);
+      _wr_reg(0x0A,0x0000);
+      _wr_reg(0x30,0x0000);
+      _wr_reg(0x31,0x0402);
+      _wr_reg(0x32,0x0106);
+      _wr_reg(0x33,0x0700);
+      _wr_reg(0x34,0x0104);
+      _wr_reg(0x35,0x0301);
+      _wr_reg(0x36,0x0707);
+      _wr_reg(0x37,0x0305);
+      _wr_reg(0x38,0x0208);
+      _wr_reg(0x39,0x0F0B);
       delay(15);
-      wr_reg(0x41,0x0002);
-      wr_reg(0x60,0x2700);
-      wr_reg(0x61,0x0001);
-      wr_reg(0x90,0x0119);
-      wr_reg(0x92,0x010A);
-      wr_reg(0x93,0x0004);
-      wr_reg(0xA0,0x0100);
+      _wr_reg(0x41,0x0002);
+      _wr_reg(0x60,0x2700);
+      _wr_reg(0x61,0x0001);
+      _wr_reg(0x90,0x0119);
+      _wr_reg(0x92,0x010A);
+      _wr_reg(0x93,0x0004);
+      _wr_reg(0xA0,0x0100);
       delay(15);
-      wr_reg(0xA0,0x0000);
+      _wr_reg(0xA0,0x0000);
       delay(20);
 #endif      
       break;
@@ -342,72 +341,72 @@
 case ILI9325_ID:    {  //2.8" TFT LCD Module, DriverIC is ILI9325
 
 #ifndef DISABLE_ILI9325
-      wr_reg(0x00e7,0x0010);
-      wr_reg(0x0000,0x0001);              //start internal osc
-      wr_reg(0x0001,0x0100); 
-      wr_reg(0x0002,0x0700);                 //power on sequence
-      wr_reg(0x0003,(1<<12)|(1<<5)|(1<<4) );     //65K 
-      wr_reg(0x0004,0x0000);
-      wr_reg(0x0008,0x0207);
-      wr_reg(0x0009,0x0000);
-      wr_reg(0x000a,0x0000);                 //display setting
-      wr_reg(0x000c,0x0001);                //display setting
-      wr_reg(0x000d,0x0000);                 //0f3c          
-      wr_reg(0x000f,0x0000);
+      _wr_reg(0x00e7,0x0010);
+      _wr_reg(0x0000,0x0001);              //start internal osc
+      _wr_reg(0x0001,0x0100); 
+      _wr_reg(0x0002,0x0700);                 //power on sequence
+      _wr_reg(0x0003,(1<<12)|(1<<5)|(1<<4) );     //65K 
+      _wr_reg(0x0004,0x0000);
+      _wr_reg(0x0008,0x0207);
+      _wr_reg(0x0009,0x0000);
+      _wr_reg(0x000a,0x0000);                 //display setting
+      _wr_reg(0x000c,0x0001);                //display setting
+      _wr_reg(0x000d,0x0000);                 //0f3c          
+      _wr_reg(0x000f,0x0000);
 //Power On sequence //
-      wr_reg(0x0010,0x0000);   
-      wr_reg(0x0011,0x0007);
-      wr_reg(0x0012,0x0000);                                                                 
-      wr_reg(0x0013,0x0000);                 
+      _wr_reg(0x0010,0x0000);   
+      _wr_reg(0x0011,0x0007);
+      _wr_reg(0x0012,0x0000);                                                                 
+      _wr_reg(0x0013,0x0000);                 
       delay(15);
-      wr_reg(0x0010,0x1590);   
-      wr_reg(0x0011,0x0227);
+      _wr_reg(0x0010,0x1590);   
+      _wr_reg(0x0011,0x0227);
       delay(15);
-      wr_reg(0x0012,0x009c);                  
+      _wr_reg(0x0012,0x009c);                  
       delay(15);
-      wr_reg(0x0013,0x1900);   
-      wr_reg(0x0029,0x0023);
-      wr_reg(0x002b,0x000e);
+      _wr_reg(0x0013,0x1900);   
+      _wr_reg(0x0029,0x0023);
+      _wr_reg(0x002b,0x000e);
       delay(15);
-      wr_reg(0x0020,0x0000);                                                            
-      wr_reg(0x0021,0x0000);           
+      _wr_reg(0x0020,0x0000);                                                            
+      _wr_reg(0x0021,0x0000);           
 ///////////////////////////////////////////////////////      
       delay(15);
-      wr_reg(0x0030,0x0007); 
-      wr_reg(0x0031,0x0707);   
-      wr_reg(0x0032,0x0006);
-      wr_reg(0x0035,0x0704);
-      wr_reg(0x0036,0x1f04); 
-      wr_reg(0x0037,0x0004);
-      wr_reg(0x0038,0x0000);        
-      wr_reg(0x0039,0x0706);     
-      wr_reg(0x003c,0x0701);
-      wr_reg(0x003d,0x000f);
+      _wr_reg(0x0030,0x0007); 
+      _wr_reg(0x0031,0x0707);   
+      _wr_reg(0x0032,0x0006);
+      _wr_reg(0x0035,0x0704);
+      _wr_reg(0x0036,0x1f04); 
+      _wr_reg(0x0037,0x0004);
+      _wr_reg(0x0038,0x0000);        
+      _wr_reg(0x0039,0x0706);     
+      _wr_reg(0x003c,0x0701);
+      _wr_reg(0x003d,0x000f);
       delay(15);
-      wr_reg(0x0050,0x0000);        
-      wr_reg(0x0051,0x00ef);   
-      wr_reg(0x0052,0x0000);     
-      wr_reg(0x0053,0x013f);
-      wr_reg(0x0060,0xa700);        
-      wr_reg(0x0061,0x0001); 
-      wr_reg(0x006a,0x0000);
-      wr_reg(0x0080,0x0000);
-      wr_reg(0x0081,0x0000);
-      wr_reg(0x0082,0x0000);
-      wr_reg(0x0083,0x0000);
-      wr_reg(0x0084,0x0000);
-      wr_reg(0x0085,0x0000);
+      _wr_reg(0x0050,0x0000);        
+      _wr_reg(0x0051,0x00ef);   
+      _wr_reg(0x0052,0x0000);     
+      _wr_reg(0x0053,0x013f);
+      _wr_reg(0x0060,0xa700);        
+      _wr_reg(0x0061,0x0001); 
+      _wr_reg(0x006a,0x0000);
+      _wr_reg(0x0080,0x0000);
+      _wr_reg(0x0081,0x0000);
+      _wr_reg(0x0082,0x0000);
+      _wr_reg(0x0083,0x0000);
+      _wr_reg(0x0084,0x0000);
+      _wr_reg(0x0085,0x0000);
       
-      wr_reg(0x0090,0x0010);     
-      wr_reg(0x0092,0x0000);  
-      wr_reg(0x0093,0x0003);
-      wr_reg(0x0095,0x0110);
-      wr_reg(0x0097,0x0000);        
-      wr_reg(0x0098,0x0000);  
+      _wr_reg(0x0090,0x0010);     
+      _wr_reg(0x0092,0x0000);  
+      _wr_reg(0x0093,0x0003);
+      _wr_reg(0x0095,0x0110);
+      _wr_reg(0x0097,0x0000);        
+      _wr_reg(0x0098,0x0000);  
       //display on sequence     
-      wr_reg(0x0007,0x0133);
-      wr_reg(0x0020,0x0000);                                                            
-      wr_reg(0x0021,0x0000);
+      _wr_reg(0x0007,0x0133);
+      _wr_reg(0x0020,0x0000);                                                            
+      _wr_reg(0x0021,0x0000);
 #endif        
       break;
 }    
@@ -416,72 +415,72 @@
 
 #ifndef DISABLE_ILI9320
       /* Start Initial Sequence --------------------------------------------------*/
-      wr_reg(0xE5, 0x8000);                 /* Set the internal vcore voltage     */
-      wr_reg(0x00, 0x0001);                 /* Start internal OSC                 */
-      wr_reg(0x01, 0x0100);                 /* Set SS and SM bit                  */
-      wr_reg(0x02, 0x0700);                 /* Set 1 line inversion               */
-      wr_reg(0x03, 0x1030);                 /* Set GRAM write direction and BGR=1 */
-      wr_reg(0x04, 0x0000);                 /* Resize register                    */
-      wr_reg(0x08, 0x0202);                 /* 2 lines each, back and front porch */
-      wr_reg(0x09, 0x0000);                 /* Set non-disp area refresh cyc ISC  */
-      wr_reg(0x0A, 0x0000);                 /* FMARK function                     */
-      wr_reg(0x0C, 0x0000);                 /* RGB interface setting              */
-      wr_reg(0x0D, 0x0000);                 /* Frame marker Position              */
-      wr_reg(0x0F, 0x0000);                 /* RGB interface polarity             */
+      _wr_reg(0xE5, 0x8000);                 /* Set the internal vcore voltage     */
+      _wr_reg(0x00, 0x0001);                 /* Start internal OSC                 */
+      _wr_reg(0x01, 0x0100);                 /* Set SS and SM bit                  */
+      _wr_reg(0x02, 0x0700);                 /* Set 1 line inversion               */
+      _wr_reg(0x03, 0x1030);                 /* Set GRAM write direction and BGR=1 */
+      _wr_reg(0x04, 0x0000);                 /* Resize register                    */
+      _wr_reg(0x08, 0x0202);                 /* 2 lines each, back and front porch */
+      _wr_reg(0x09, 0x0000);                 /* Set non-disp area refresh cyc ISC  */
+      _wr_reg(0x0A, 0x0000);                 /* FMARK function                     */
+      _wr_reg(0x0C, 0x0000);                 /* RGB interface setting              */
+      _wr_reg(0x0D, 0x0000);                 /* Frame marker Position              */
+      _wr_reg(0x0F, 0x0000);                 /* RGB interface polarity             */
     
       /* Power On sequence -------------------------------------------------------*/
-      wr_reg(0x10, 0x0000);                 /* Reset Power Control 1              */
-      wr_reg(0x11, 0x0000);                 /* Reset Power Control 2              */
-      wr_reg(0x12, 0x0000);                 /* Reset Power Control 3              */
-      wr_reg(0x13, 0x0000);                 /* Reset Power Control 4              */
+      _wr_reg(0x10, 0x0000);                 /* Reset Power Control 1              */
+      _wr_reg(0x11, 0x0000);                 /* Reset Power Control 2              */
+      _wr_reg(0x12, 0x0000);                 /* Reset Power Control 3              */
+      _wr_reg(0x13, 0x0000);                 /* Reset Power Control 4              */
       delay(20);                            /* Discharge cap power voltage (200ms)*/
-      wr_reg(0x10, 0x17B0);                 /* SAP, BT[3:0], AP, DSTB, SLP, STB   */
-      wr_reg(0x11, 0x0137);                 /* DC1[2:0], DC0[2:0], VC[2:0]        */
+      _wr_reg(0x10, 0x17B0);                 /* SAP, BT[3:0], AP, DSTB, SLP, STB   */
+      _wr_reg(0x11, 0x0137);                 /* DC1[2:0], DC0[2:0], VC[2:0]        */
       delay(5);                             /* Delay 50 ms                        */
-      wr_reg(0x12, 0x0139);                 /* VREG1OUT voltage                   */
+      _wr_reg(0x12, 0x0139);                 /* VREG1OUT voltage                   */
       delay(5);                             /* Delay 50 ms                        */
-      wr_reg(0x13, 0x1D00);                 /* VDV[4:0] for VCOM amplitude        */
-      wr_reg(0x29, 0x0013);                 /* VCM[4:0] for VCOMH                 */
+      _wr_reg(0x13, 0x1D00);                 /* VDV[4:0] for VCOM amplitude        */
+      _wr_reg(0x29, 0x0013);                 /* VCM[4:0] for VCOMH                 */
       delay(5);                             /* Delay 50 ms                        */
-      wr_reg(0x20, 0x0000);                 /* GRAM horizontal Address            */
-      wr_reg(0x21, 0x0000);                 /* GRAM Vertical Address              */
+      _wr_reg(0x20, 0x0000);                 /* GRAM horizontal Address            */
+      _wr_reg(0x21, 0x0000);                 /* GRAM Vertical Address              */
     
       /* Adjust the Gamma Curve --------------------------------------------------*/
-      wr_reg(0x30, 0x0006);
-      wr_reg(0x31, 0x0101);
-      wr_reg(0x32, 0x0003);
-      wr_reg(0x35, 0x0106);
-      wr_reg(0x36, 0x0B02);
-      wr_reg(0x37, 0x0302);
-      wr_reg(0x38, 0x0707);
-      wr_reg(0x39, 0x0007);
-      wr_reg(0x3C, 0x0600);
-      wr_reg(0x3D, 0x020B);
+      _wr_reg(0x30, 0x0006);
+      _wr_reg(0x31, 0x0101);
+      _wr_reg(0x32, 0x0003);
+      _wr_reg(0x35, 0x0106);
+      _wr_reg(0x36, 0x0B02);
+      _wr_reg(0x37, 0x0302);
+      _wr_reg(0x38, 0x0707);
+      _wr_reg(0x39, 0x0007);
+      _wr_reg(0x3C, 0x0600);
+      _wr_reg(0x3D, 0x020B);
       
       /* Set GRAM area -----------------------------------------------------------*/
-      wr_reg(0x50, 0x0000);                 /* Horizontal GRAM Start Address      */
-      wr_reg(0x51, (HEIGHT-1));             /* Horizontal GRAM End   Address      */
-      wr_reg(0x52, 0x0000);                 /* Vertical   GRAM Start Address      */
-      wr_reg(0x53, (WIDTH-1));              /* Vertical   GRAM End   Address      */
-      wr_reg(0x60, 0x2700);                 /* Gate Scan Line                     */
-      wr_reg(0x61, 0x0001);                 /* NDL,VLE, REV                       */
-      wr_reg(0x6A, 0x0000);                 /* Set scrolling line                 */
+      _wr_reg(0x50, 0x0000);                 /* Horizontal GRAM Start Address      */
+      _wr_reg(0x51, (HEIGHT-1));             /* Horizontal GRAM End   Address      */
+      _wr_reg(0x52, 0x0000);                 /* Vertical   GRAM Start Address      */
+      _wr_reg(0x53, (WIDTH-1));              /* Vertical   GRAM End   Address      */
+      _wr_reg(0x60, 0x2700);                 /* Gate Scan Line                     */
+      _wr_reg(0x61, 0x0001);                 /* NDL,VLE, REV                       */
+      _wr_reg(0x6A, 0x0000);                 /* Set scrolling line                 */
     
       /* Partial Display Control -------------------------------------------------*/
-      wr_reg(0x80, 0x0000);
-      wr_reg(0x81, 0x0000);
-      wr_reg(0x82, 0x0000);
-      wr_reg(0x83, 0x0000);
-      wr_reg(0x84, 0x0000);
-      wr_reg(0x85, 0x0000);
+      _wr_reg(0x80, 0x0000);
+      _wr_reg(0x81, 0x0000);
+      _wr_reg(0x82, 0x0000);
+      _wr_reg(0x83, 0x0000);
+      _wr_reg(0x84, 0x0000);
+      _wr_reg(0x85, 0x0000);
     
       /* Panel Control -----------------------------------------------------------*/
-      wr_reg(0x90, 0x0010);
-      wr_reg(0x92, 0x0000);
-      wr_reg(0x93, 0x0003);
-      wr_reg(0x95, 0x0110);
-      wr_reg(0x97, 0x0000);
-      wr_reg(0x98, 0x0000);
+      _wr_reg(0x90, 0x0010);
+      _wr_reg(0x92, 0x0000);
+      _wr_reg(0x93, 0x0003);
+      _wr_reg(0x95, 0x0110);
+      _wr_reg(0x97, 0x0000);
+      _wr_reg(0x98, 0x0000);
 #endif
     
       break;
@@ -490,67 +489,67 @@
     case ILI9331_ID: {
 
 #ifndef DISABLE_ILI9331
-      wr_reg(0x00E7, 0x1014);
-      wr_reg(0x0001, 0x0100); /* set SS and SM bit */
-      wr_reg(0x0002, 0x0200); /* set 1 line inversion */
-      wr_reg(0x0003, 0x1030); /* set GRAM write direction and BGR=1 */
-      wr_reg(0x0008, 0x0202); /* set the back porch and front porch */
-      wr_reg(0x0009, 0x0000); /* set non-display area refresh cycle ISC[3:0] */
-      wr_reg(0x000A, 0x0000); /* FMARK function */
-      wr_reg(0x000C, 0x0000); /* RGB interface setting */
-      wr_reg(0x000D, 0x0000); /* Frame marker Position */
-      wr_reg(0x000F, 0x0000); /* RGB interface polarity */
+      _wr_reg(0x00E7, 0x1014);
+      _wr_reg(0x0001, 0x0100); /* set SS and SM bit */
+      _wr_reg(0x0002, 0x0200); /* set 1 line inversion */
+      _wr_reg(0x0003, 0x1030); /* set GRAM write direction and BGR=1 */
+      _wr_reg(0x0008, 0x0202); /* set the back porch and front porch */
+      _wr_reg(0x0009, 0x0000); /* set non-display area refresh cycle ISC[3:0] */
+      _wr_reg(0x000A, 0x0000); /* FMARK function */
+      _wr_reg(0x000C, 0x0000); /* RGB interface setting */
+      _wr_reg(0x000D, 0x0000); /* Frame marker Position */
+      _wr_reg(0x000F, 0x0000); /* RGB interface polarity */
       /* Power On sequence */
-      wr_reg(0x0010, 0x0000);  /* SAP, BT[3:0], AP, DSTB, SLP, STB   */
-      wr_reg(0x0011, 0x0007);  /* DC1[2:0], DC0[2:0], VC[2:0] */
-      wr_reg(0x0012, 0x0000);  /* VREG1OUT voltage   */
-      wr_reg(0x0013, 0x0000);  /* VDV[4:0] for VCOM amplitude */
+      _wr_reg(0x0010, 0x0000);  /* SAP, BT[3:0], AP, DSTB, SLP, STB   */
+      _wr_reg(0x0011, 0x0007);  /* DC1[2:0], DC0[2:0], VC[2:0] */
+      _wr_reg(0x0012, 0x0000);  /* VREG1OUT voltage   */
+      _wr_reg(0x0013, 0x0000);  /* VDV[4:0] for VCOM amplitude */
       delay(200); /* delay 200 ms */
-      wr_reg(0x0010, 0x1690);  /* SAP, BT[3:0], AP, DSTB, SLP, STB   */
-      wr_reg(0x0011, 0x0227);  /* DC1[2:0], DC0[2:0], VC[2:0] */
+      _wr_reg(0x0010, 0x1690);  /* SAP, BT[3:0], AP, DSTB, SLP, STB   */
+      _wr_reg(0x0011, 0x0227);  /* DC1[2:0], DC0[2:0], VC[2:0] */
       delay(50); /* delay 50 ms */
-      wr_reg(0x0012, 0x000C); /* Internal reference voltage= Vci   */
+      _wr_reg(0x0012, 0x000C); /* Internal reference voltage= Vci   */
       delay(50); /* delay 50 ms */
-      wr_reg(0x0013, 0x0800); /* Set VDV[4:0] for VCOM amplitude */
-      wr_reg(0x0029, 0x0011); /* Set VCM[5:0] for VCOMH */
-      wr_reg(0x002B, 0x000B); /* Set Frame Rate */
+      _wr_reg(0x0013, 0x0800); /* Set VDV[4:0] for VCOM amplitude */
+      _wr_reg(0x0029, 0x0011); /* Set VCM[5:0] for VCOMH */
+      _wr_reg(0x002B, 0x000B); /* Set Frame Rate */
       delay(50); /* delay 50 ms */
-      wr_reg(0x0020, 0x0000); /* GRAM horizontal Address */
-      wr_reg(0x0021, 0x0000); /* GRAM Vertical Address */
+      _wr_reg(0x0020, 0x0000); /* GRAM horizontal Address */
+      _wr_reg(0x0021, 0x0000); /* GRAM Vertical Address */
       /* Adjust the Gamma Curve */
-      wr_reg(0x0030, 0x0000);
-      wr_reg(0x0031, 0x0106);
-      wr_reg(0x0032, 0x0000);
-      wr_reg(0x0035, 0x0204);
-      wr_reg(0x0036, 0x160A);
-      wr_reg(0x0037, 0x0707);
-      wr_reg(0x0038, 0x0106);
-      wr_reg(0x0039, 0x0707);
-      wr_reg(0x003C, 0x0402);
-      wr_reg(0x003D, 0x0C0F);
+      _wr_reg(0x0030, 0x0000);
+      _wr_reg(0x0031, 0x0106);
+      _wr_reg(0x0032, 0x0000);
+      _wr_reg(0x0035, 0x0204);
+      _wr_reg(0x0036, 0x160A);
+      _wr_reg(0x0037, 0x0707);
+      _wr_reg(0x0038, 0x0106);
+      _wr_reg(0x0039, 0x0707);
+      _wr_reg(0x003C, 0x0402);
+      _wr_reg(0x003D, 0x0C0F);
       /* Set GRAM area */
-      wr_reg(0x0050, 0x0000); /* Horizontal GRAM Start Address */
-      wr_reg(0x0051, 0x00EF); /* Horizontal GRAM End Address */
-      wr_reg(0x0052, 0x0000); /* Vertical GRAM Start Address */
-      wr_reg(0x0053, 0x013F); /* Vertical GRAM Start Address */
-      wr_reg(0x0060, 0x2700); /* Gate Scan Line */
-      wr_reg(0x0061, 0x0001); /*  NDL,VLE, REV */
-      wr_reg(0x006A, 0x0000); /* set scrolling line */
+      _wr_reg(0x0050, 0x0000); /* Horizontal GRAM Start Address */
+      _wr_reg(0x0051, 0x00EF); /* Horizontal GRAM End Address */
+      _wr_reg(0x0052, 0x0000); /* Vertical GRAM Start Address */
+      _wr_reg(0x0053, 0x013F); /* Vertical GRAM Start Address */
+      _wr_reg(0x0060, 0x2700); /* Gate Scan Line */
+      _wr_reg(0x0061, 0x0001); /*  NDL,VLE, REV */
+      _wr_reg(0x006A, 0x0000); /* set scrolling line */
       /* Partial Display Control */
-      wr_reg(0x0080, 0x0000);
-      wr_reg(0x0081, 0x0000);
-      wr_reg(0x0082, 0x0000);
-      wr_reg(0x0083, 0x0000);
-      wr_reg(0x0084, 0x0000);
-      wr_reg(0x0085, 0x0000);
+      _wr_reg(0x0080, 0x0000);
+      _wr_reg(0x0081, 0x0000);
+      _wr_reg(0x0082, 0x0000);
+      _wr_reg(0x0083, 0x0000);
+      _wr_reg(0x0084, 0x0000);
+      _wr_reg(0x0085, 0x0000);
       /* Panel Control */
-      wr_reg(0x0090, 0x0010);
-      wr_reg(0x0092, 0x0600);
-      wr_reg(0x0007,0x0021);
+      _wr_reg(0x0090, 0x0010);
+      _wr_reg(0x0092, 0x0600);
+      _wr_reg(0x0007,0x0021);
       delay(50); /* delay 50 ms */
-      wr_reg(0x0007,0x0061);
+      _wr_reg(0x0007,0x0061);
       delay(50); /* delay 50 ms */
-      wr_reg(0x0007,0x0133); /* 262K color and display ON */
+      _wr_reg(0x0007,0x0133); /* 262K color and display ON */
 #endif      
       break;
     }
@@ -558,67 +557,67 @@
     case SSD1289_ID: {     //3.2" TFT LCD Module,DriverIC is SSD1289
 
 #ifndef DISABLE_SSD1289_ID
-      wr_reg(0x0007,0x0233);    delay(5);        //0x0233    Set this first or init fails !
+      _wr_reg(0x0007,0x0233);    delay(5);        //0x0233    Set this first or init fails !
             
-      wr_reg(0x0000,0x0001);    delay(5);  // osc en
+      _wr_reg(0x0000,0x0001);    delay(5);  // osc en
       
-      wr_reg(0x0003,0xA8A4);    delay(5);  // powercontrol 1 0xA8A4
-      wr_reg(0x000C,0x0000);    delay(5);  // powercontrol 2  
-      wr_reg(0x000D,0x080C);    delay(5);  // powercontrol 3  
-      wr_reg(0x000E,0x2B00);    delay(5);  // powercontrol 4        
-      wr_reg(0x001E,0x00B0);    delay(5);  // powercontrol 5
+      _wr_reg(0x0003,0xA8A4);    delay(5);  // powercontrol 1 0xA8A4
+      _wr_reg(0x000C,0x0000);    delay(5);  // powercontrol 2  
+      _wr_reg(0x000D,0x080C);    delay(5);  // powercontrol 3  
+      _wr_reg(0x000E,0x2B00);    delay(5);  // powercontrol 4        
+      _wr_reg(0x001E,0x00B0);    delay(5);  // powercontrol 5
          
-//orig     wr_reg(0x0001,0x2b3F);    delay(5);  // 0x2b3f Mux=320, BGR, RL=0, TB=1
-      wr_reg(0x0001,0x6B3F);    delay(5);  // 0x6B3F Mux=320, BGR, RL=1, TB=1                   
-//          wr_reg(0x0001,0x293F);    delay(5);  // 0x293f Mux=320, BGR, RL=0, TB=0
+//orig     _wr_reg(0x0001,0x2b3F);    delay(5);  // 0x2b3f Mux=320, BGR, RL=0, TB=1
+      _wr_reg(0x0001,0x6B3F);    delay(5);  // 0x6B3F Mux=320, BGR, RL=1, TB=1                   
+//          _wr_reg(0x0001,0x293F);    delay(5);  // 0x293f Mux=320, BGR, RL=0, TB=0
       
             
-      wr_reg(0x0002,0x0600);    delay(5);  // Driver AC mode
-      wr_reg(0x0010,0x0000);    delay(5);  // Exit Sleep
+      _wr_reg(0x0002,0x0600);    delay(5);  // Driver AC mode
+      _wr_reg(0x0010,0x0000);    delay(5);  // Exit Sleep
 
-      wr_reg(0x0011,0x6078);    delay(5);  // Entry mode 0x6078 = 65k colors, Hor and Vert Addr Incr, AM=1 vert writing dir
-//      wr_reg(0x0011,0x4030);    delay(5);  // Entry mode 0x4030 = 262k colors, Hor and Vert Addr Incr. AM=0 hor writing dir
+      _wr_reg(0x0011,0x6078);    delay(5);  // Entry mode 0x6078 = 65k colors, Hor and Vert Addr Incr, AM=1 vert writing dir
+//      _wr_reg(0x0011,0x4030);    delay(5);  // Entry mode 0x4030 = 262k colors, Hor and Vert Addr Incr. AM=0 hor writing dir
 
-      wr_reg(0x0005,0x0000);    delay(5);  // Compare Regs (default)
-      wr_reg(0x0006,0x0000);    delay(5);
+      _wr_reg(0x0005,0x0000);    delay(5);  // Compare Regs (default)
+      _wr_reg(0x0006,0x0000);    delay(5);
       
-      wr_reg(0x0016,0xEF1C);    delay(5);  // Hor Porch (default)
-      wr_reg(0x0017,0x0003);    delay(5);  // Ver Porch (default 0103)
-      wr_reg(0x0007,0x0233);    delay(5);        //0x0233       
-      wr_reg(0x000B,0x0000);    delay(5);  // Frame cycle control default 5308)
+      _wr_reg(0x0016,0xEF1C);    delay(5);  // Hor Porch (default)
+      _wr_reg(0x0017,0x0003);    delay(5);  // Ver Porch (default 0103)
+      _wr_reg(0x0007,0x0233);    delay(5);        //0x0233       
+      _wr_reg(0x000B,0x0000);    delay(5);  // Frame cycle control default 5308)
       
-      wr_reg(0x000F,0x0000);    delay(5);  // Gate scan start position
+      _wr_reg(0x000F,0x0000);    delay(5);  // Gate scan start position
 
-      wr_reg(0x0041,0x0000);    delay(5);  // Vert Scroll control
-      wr_reg(0x0042,0x0000);    delay(5);
+      _wr_reg(0x0041,0x0000);    delay(5);  // Vert Scroll control
+      _wr_reg(0x0042,0x0000);    delay(5);
 
-      wr_reg(0x0048,0x0000);    delay(5);  // First screen pos (default)
-      wr_reg(0x0049,0x013F);    delay(5);
+      _wr_reg(0x0048,0x0000);    delay(5);  // First screen pos (default)
+      _wr_reg(0x0049,0x013F);    delay(5);
       
-      wr_reg(0x004A,0x0000);    delay(5);  // Second screen pos
-      wr_reg(0x004B,0x0000);    delay(5);
+      _wr_reg(0x004A,0x0000);    delay(5);  // Second screen pos
+      _wr_reg(0x004B,0x0000);    delay(5);
       
-      wr_reg(0x0044,0xEF00);    delay(5);  // Hor addr pos
-      wr_reg(0x0045,0x0000);    delay(5);  // Vert Addr pos
-      wr_reg(0x0046,0x013F);    delay(5);
+      _wr_reg(0x0044,0xEF00);    delay(5);  // Hor addr pos
+      _wr_reg(0x0045,0x0000);    delay(5);  // Vert Addr pos
+      _wr_reg(0x0046,0x013F);    delay(5);
       
-      wr_reg(0x0030,0x0707);    delay(5);  // Gamma
-      wr_reg(0x0031,0x0204);    delay(5);
-      wr_reg(0x0032,0x0204);    delay(5);
-      wr_reg(0x0033,0x0502);    delay(5);
-      wr_reg(0x0034,0x0507);    delay(5);
-      wr_reg(0x0035,0x0204);    delay(5);
-      wr_reg(0x0036,0x0204);    delay(5);
-      wr_reg(0x0037,0x0502);    delay(5);
-      wr_reg(0x003A,0x0302);    delay(5);
-      wr_reg(0x003B,0x0302);    delay(5);
+      _wr_reg(0x0030,0x0707);    delay(5);  // Gamma
+      _wr_reg(0x0031,0x0204);    delay(5);
+      _wr_reg(0x0032,0x0204);    delay(5);
+      _wr_reg(0x0033,0x0502);    delay(5);
+      _wr_reg(0x0034,0x0507);    delay(5);
+      _wr_reg(0x0035,0x0204);    delay(5);
+      _wr_reg(0x0036,0x0204);    delay(5);
+      _wr_reg(0x0037,0x0502);    delay(5);
+      _wr_reg(0x003A,0x0302);    delay(5);
+      _wr_reg(0x003B,0x0302);    delay(5);
       
-      wr_reg(0x0023,0x0000);    delay(5);  // Write data mask (default)
-      wr_reg(0x0024,0x0000);    delay(5);
+      _wr_reg(0x0023,0x0000);    delay(5);  // Write data mask (default)
+      _wr_reg(0x0024,0x0000);    delay(5);
       
-      wr_reg(0x0025,0x8000);    delay(5);  // Frame freq 65 Hz
-      wr_reg(0x004e,0);                    // Start x
-      wr_reg(0x004f,0);                    // Start y     
+      _wr_reg(0x0025,0x8000);    delay(5);  // Frame freq 65 Hz
+      _wr_reg(0x004e,0);                    // Start x
+      _wr_reg(0x004f,0);                    // Start y     
 #endif        
       break;
     }
@@ -627,54 +626,54 @@
   case SSD1298_ID: {
 
 #ifndef DISABLE_SSD1298_ID
-      wr_reg(0x0028,0x0006);
-      wr_reg(0x0000,0x0001);
-      wr_reg(0x0003,0xaea4); /* power control 1---line frequency and VHG,VGL voltage */
-      wr_reg(0x000c,0x0004); /* power control 2---VCIX2 output voltage */
-      wr_reg(0x000d,0x000c); /* power control 3---Vlcd63 voltage */
-      wr_reg(0x000e,0x2800); /* power control 4---VCOMA voltage VCOML=VCOMH*0.9475-VCOMA */
-      wr_reg(0x001e,0x00b5); /* POWER CONTROL 5---VCOMH voltage */
-      wr_reg(0x0001,0x3b3f);
-      wr_reg(0x0002,0x0600);
-      wr_reg(0x0010,0x0000);
-      wr_reg(0x0011,0x6830);
-      wr_reg(0x0005,0x0000);
-      wr_reg(0x0006,0x0000);
-      wr_reg(0x0016,0xef1c);
-      wr_reg(0x0007,0x0033); /* Display control 1 */
+      _wr_reg(0x0028,0x0006);
+      _wr_reg(0x0000,0x0001);
+      _wr_reg(0x0003,0xaea4); /* power control 1---line frequency and VHG,VGL voltage */
+      _wr_reg(0x000c,0x0004); /* power control 2---VCIX2 output voltage */
+      _wr_reg(0x000d,0x000c); /* power control 3---Vlcd63 voltage */
+      _wr_reg(0x000e,0x2800); /* power control 4---VCOMA voltage VCOML=VCOMH*0.9475-VCOMA */
+      _wr_reg(0x001e,0x00b5); /* POWER CONTROL 5---VCOMH voltage */
+      _wr_reg(0x0001,0x3b3f);
+      _wr_reg(0x0002,0x0600);
+      _wr_reg(0x0010,0x0000);
+      _wr_reg(0x0011,0x6830);
+      _wr_reg(0x0005,0x0000);
+      _wr_reg(0x0006,0x0000);
+      _wr_reg(0x0016,0xef1c);
+      _wr_reg(0x0007,0x0033); /* Display control 1 */
       /* when GON=1 and DTE=0,all gate outputs become VGL */
       /* when GON=1 and DTE=0,all gate outputs become VGH */
       /* non-selected gate wires become VGL */
-      wr_reg(0x000b,0x0000);
-      wr_reg(0x000f,0x0000);
-      wr_reg(0x0041,0x0000);
-      wr_reg(0x0042,0x0000);
-      wr_reg(0x0048,0x0000);
-      wr_reg(0x0049,0x013f);
-      wr_reg(0x004a,0x0000);
-      wr_reg(0x004b,0x0000);
-      wr_reg(0x0044,0xef00); /* Horizontal RAM start and end address */
-      wr_reg(0x0045,0x0000); /* Vretical RAM start address */
-      wr_reg(0x0046,0x013f); /* Vretical RAM end address */
-      wr_reg(0x004e,0x0000); /* set GDDRAM x address counter */
-      wr_reg(0x004f,0x0000); /* set GDDRAM y address counter */
+      _wr_reg(0x000b,0x0000);
+      _wr_reg(0x000f,0x0000);
+      _wr_reg(0x0041,0x0000);
+      _wr_reg(0x0042,0x0000);
+      _wr_reg(0x0048,0x0000);
+      _wr_reg(0x0049,0x013f);
+      _wr_reg(0x004a,0x0000);
+      _wr_reg(0x004b,0x0000);
+      _wr_reg(0x0044,0xef00); /* Horizontal RAM start and end address */
+      _wr_reg(0x0045,0x0000); /* Vretical RAM start address */
+      _wr_reg(0x0046,0x013f); /* Vretical RAM end address */
+      _wr_reg(0x004e,0x0000); /* set GDDRAM x address counter */
+      _wr_reg(0x004f,0x0000); /* set GDDRAM y address counter */
       /* y control */
-      wr_reg(0x0030,0x0707);
-      wr_reg(0x0031,0x0202);
-      wr_reg(0x0032,0x0204);
-      wr_reg(0x0033,0x0502);
-      wr_reg(0x0034,0x0507);
-      wr_reg(0x0035,0x0204);
-      wr_reg(0x0036,0x0204);
-      wr_reg(0x0037,0x0502);
-      wr_reg(0x003a,0x0302);
-      wr_reg(0x003b,0x0302);
-      wr_reg(0x0023,0x0000);
-      wr_reg(0x0024,0x0000);
-      wr_reg(0x0025,0x8000);
-      wr_reg(0x0026,0x7000);
-      wr_reg(0x0020,0xb0eb);
-      wr_reg(0x0027,0x007c);
+      _wr_reg(0x0030,0x0707);
+      _wr_reg(0x0031,0x0202);
+      _wr_reg(0x0032,0x0204);
+      _wr_reg(0x0033,0x0502);
+      _wr_reg(0x0034,0x0507);
+      _wr_reg(0x0035,0x0204);
+      _wr_reg(0x0036,0x0204);
+      _wr_reg(0x0037,0x0502);
+      _wr_reg(0x003a,0x0302);
+      _wr_reg(0x003b,0x0302);
+      _wr_reg(0x0023,0x0000);
+      _wr_reg(0x0024,0x0000);
+      _wr_reg(0x0025,0x8000);
+      _wr_reg(0x0026,0x7000);
+      _wr_reg(0x0020,0xb0eb);
+      _wr_reg(0x0027,0x007c);
 #endif
       break;
    }
@@ -683,37 +682,37 @@
 
 #ifndef DISABLE_SSD2119_ID
       /* POWER ON & RESET DISPLAY OFF */
-      wr_reg(0x28,0x0006);
-      wr_reg(0x00,0x0001);
-      wr_reg(0x10,0x0000);
-      wr_reg(0x01,0x72ef);
-      wr_reg(0x02,0x0600);
-      wr_reg(0x03,0x6a38);
-      wr_reg(0x11,0x6874);
-      wr_reg(0x0f,0x0000); /* RAM WRITE DATA MASK */
-      wr_reg(0x0b,0x5308); /* RAM WRITE DATA MASK */
-      wr_reg(0x0c,0x0003);
-      wr_reg(0x0d,0x000a);
-      wr_reg(0x0e,0x2e00);
-      wr_reg(0x1e,0x00be);
-      wr_reg(0x25,0x8000);
-      wr_reg(0x26,0x7800);
-      wr_reg(0x27,0x0078);
-      wr_reg(0x4e,0x0000);
-      wr_reg(0x4f,0x0000);
-      wr_reg(0x12,0x08d9);
+      _wr_reg(0x28,0x0006);
+      _wr_reg(0x00,0x0001);
+      _wr_reg(0x10,0x0000);
+      _wr_reg(0x01,0x72ef);
+      _wr_reg(0x02,0x0600);
+      _wr_reg(0x03,0x6a38);
+      _wr_reg(0x11,0x6874);
+      _wr_reg(0x0f,0x0000); /* RAM WRITE DATA MASK */
+      _wr_reg(0x0b,0x5308); /* RAM WRITE DATA MASK */
+      _wr_reg(0x0c,0x0003);
+      _wr_reg(0x0d,0x000a);
+      _wr_reg(0x0e,0x2e00);
+      _wr_reg(0x1e,0x00be);
+      _wr_reg(0x25,0x8000);
+      _wr_reg(0x26,0x7800);
+      _wr_reg(0x27,0x0078);
+      _wr_reg(0x4e,0x0000);
+      _wr_reg(0x4f,0x0000);
+      _wr_reg(0x12,0x08d9);
       /* Adjust the Gamma Curve */
-      wr_reg(0x30,0x0000);
-      wr_reg(0x31,0x0104);
-      wr_reg(0x32,0x0100);
-      wr_reg(0x33,0x0305);
-      wr_reg(0x34,0x0505);
-      wr_reg(0x35,0x0305);
-      wr_reg(0x36,0x0707);
-      wr_reg(0x37,0x0300);
-      wr_reg(0x3a,0x1200);
-      wr_reg(0x3b,0x0800);
-      wr_reg(0x07,0x0033);
+      _wr_reg(0x30,0x0000);
+      _wr_reg(0x31,0x0104);
+      _wr_reg(0x32,0x0100);
+      _wr_reg(0x33,0x0305);
+      _wr_reg(0x34,0x0505);
+      _wr_reg(0x35,0x0305);
+      _wr_reg(0x36,0x0707);
+      _wr_reg(0x37,0x0300);
+      _wr_reg(0x3a,0x1200);
+      _wr_reg(0x3b,0x0800);
+      _wr_reg(0x07,0x0033);
 #endif      
       break;
     }
@@ -728,77 +727,77 @@
 
 #ifndef DISABLE_R61505U
       /* second release on 3/5  ,luminance is acceptable,water wave appear during camera preview */
-       wr_reg(0x0007,0x0000);
+       _wr_reg(0x0007,0x0000);
        delay(50);  /* delay 50 ms */      
-       wr_reg(0x0012,0x011C);    /* why need to set several times?   */
-       wr_reg(0x00A4,0x0001);    /* NVM */
-       wr_reg(0x0008,0x000F);
-       wr_reg(0x000A,0x0008);
-       wr_reg(0x000D,0x0008);
+       _wr_reg(0x0012,0x011C);    /* why need to set several times?   */
+       _wr_reg(0x00A4,0x0001);    /* NVM */
+       _wr_reg(0x0008,0x000F);
+       _wr_reg(0x000A,0x0008);
+       _wr_reg(0x000D,0x0008);
        /* GAMMA CONTROL */
-       wr_reg(0x0030,0x0707);
-       wr_reg(0x0031,0x0007);
-       wr_reg(0x0032,0x0603);
-       wr_reg(0x0033,0x0700);
-       wr_reg(0x0034,0x0202);
-       wr_reg(0x0035,0x0002);
-       wr_reg(0x0036,0x1F0F);
-       wr_reg(0x0037,0x0707);
-       wr_reg(0x0038,0x0000);
-       wr_reg(0x0039,0x0000);
-       wr_reg(0x003A,0x0707);
-       wr_reg(0x003B,0x0000);
-       wr_reg(0x003C,0x0007);
-       wr_reg(0x003D,0x0000);
+       _wr_reg(0x0030,0x0707);
+       _wr_reg(0x0031,0x0007);
+       _wr_reg(0x0032,0x0603);
+       _wr_reg(0x0033,0x0700);
+       _wr_reg(0x0034,0x0202);
+       _wr_reg(0x0035,0x0002);
+       _wr_reg(0x0036,0x1F0F);
+       _wr_reg(0x0037,0x0707);
+       _wr_reg(0x0038,0x0000);
+       _wr_reg(0x0039,0x0000);
+       _wr_reg(0x003A,0x0707);
+       _wr_reg(0x003B,0x0000);
+       _wr_reg(0x003C,0x0007);
+       _wr_reg(0x003D,0x0000);
        delay(50);  /* delay 50 ms */      
-       wr_reg(0x0007,0x0001);
-       wr_reg(0x0017,0x0001);    /* Power supply startup enable */
+       _wr_reg(0x0007,0x0001);
+       _wr_reg(0x0017,0x0001);    /* Power supply startup enable */
        delay(50);  /* delay 50 ms */      
        /* power control */
-       wr_reg(0x0010,0x17A0);
-       wr_reg(0x0011,0x0217); /* reference voltage VC[2:0]   Vciout = 1.00*Vcivl */
-       wr_reg(0x0012,0x011E); /* Vreg1out = Vcilvl*1.80   is it the same as Vgama1out ?   */
-       wr_reg(0x0013,0x0F00); /* VDV[4:0]-->VCOM Amplitude VcomL = VcomH - Vcom Ampl */
-       wr_reg(0x002A,0x0000);
-       wr_reg(0x0029,0x000A); /* Vcomh = VCM1[4:0]*Vreg1out    gate source voltage?? */
-       wr_reg(0x0012,0x013E); /* power supply on */
+       _wr_reg(0x0010,0x17A0);
+       _wr_reg(0x0011,0x0217); /* reference voltage VC[2:0]   Vciout = 1.00*Vcivl */
+       _wr_reg(0x0012,0x011E); /* Vreg1out = Vcilvl*1.80   is it the same as Vgama1out ?   */
+       _wr_reg(0x0013,0x0F00); /* VDV[4:0]-->VCOM Amplitude VcomL = VcomH - Vcom Ampl */
+       _wr_reg(0x002A,0x0000);
+       _wr_reg(0x0029,0x000A); /* Vcomh = VCM1[4:0]*Vreg1out    gate source voltage?? */
+       _wr_reg(0x0012,0x013E); /* power supply on */
        /* Coordinates Control */
-       wr_reg(0x0050,0x0000);
-       wr_reg(0x0051,0x00EF);
-       wr_reg(0x0052,0x0000);
-       wr_reg(0x0053,0x013F);
+       _wr_reg(0x0050,0x0000);
+       _wr_reg(0x0051,0x00EF);
+       _wr_reg(0x0052,0x0000);
+       _wr_reg(0x0053,0x013F);
        /* Pannel Image Control */
-       wr_reg(0x0060,0x2700);
-       wr_reg(0x0061,0x0001);
-       wr_reg(0x006A,0x0000);
-       wr_reg(0x0080,0x0000);
+       _wr_reg(0x0060,0x2700);
+       _wr_reg(0x0061,0x0001);
+       _wr_reg(0x006A,0x0000);
+       _wr_reg(0x0080,0x0000);
        /* Partial Image Control */
-       wr_reg(0x0081,0x0000);
-       wr_reg(0x0082,0x0000);
-       wr_reg(0x0083,0x0000);
-       wr_reg(0x0084,0x0000);
-       wr_reg(0x0085,0x0000);
+       _wr_reg(0x0081,0x0000);
+       _wr_reg(0x0082,0x0000);
+       _wr_reg(0x0083,0x0000);
+       _wr_reg(0x0084,0x0000);
+       _wr_reg(0x0085,0x0000);
        /* Panel Interface Control */
-       wr_reg(0x0090,0x0013);      /* frenqucy */   
-       wr_reg(0x0092,0x0300);
-       wr_reg(0x0093,0x0005);
-       wr_reg(0x0095,0x0000);
-       wr_reg(0x0097,0x0000);
-       wr_reg(0x0098,0x0000);
+       _wr_reg(0x0090,0x0013);      /* frenqucy */   
+       _wr_reg(0x0092,0x0300);
+       _wr_reg(0x0093,0x0005);
+       _wr_reg(0x0095,0x0000);
+       _wr_reg(0x0097,0x0000);
+       _wr_reg(0x0098,0x0000);
 
-       wr_reg(0x0001,0x0100);
-       wr_reg(0x0002,0x0700);
-       wr_reg(0x0003,0x1030);
-       wr_reg(0x0004,0x0000);
-       wr_reg(0x000C,0x0000);
-       wr_reg(0x000F,0x0000);
-       wr_reg(0x0020,0x0000);
-       wr_reg(0x0021,0x0000);
-       wr_reg(0x0007,0x0021);
+       _wr_reg(0x0001,0x0100);
+       _wr_reg(0x0002,0x0700);
+       _wr_reg(0x0003,0x1030);
+       _wr_reg(0x0004,0x0000);
+       _wr_reg(0x000C,0x0000);
+       _wr_reg(0x000F,0x0000);
+       _wr_reg(0x0020,0x0000);
+       _wr_reg(0x0021,0x0000);
+       _wr_reg(0x0007,0x0021);
        delay(200);  /* delay 200 ms */      
-       wr_reg(0x0007,0x0061);
+       _wr_reg(0x0007,0x0061);
        delay(200);  /* delay 200 ms */      
-       wr_reg(0x0007,0x0173);
+       _wr_reg(0x0007,0x0173);
 #endif
      break;
    } 
@@ -806,49 +805,49 @@
  case SPFD5408B_ID: {
 
 #ifndef DISABLE_SPFD5408B
-      wr_reg(0x0001,0x0100);     /* Driver Output Contral Register */ 
-      wr_reg(0x0002,0x0700);      /* LCD Driving Waveform Contral */
-      wr_reg(0x0003,0x1030);     /* Entry ModeÉèÖÃ */
+      _wr_reg(0x0001,0x0100);     /* Driver Output Contral Register */ 
+      _wr_reg(0x0002,0x0700);      /* LCD Driving Waveform Contral */
+      _wr_reg(0x0003,0x1030);     /* Entry ModeÉèÖÃ */
       
-      wr_reg(0x0004,0x0000);     /* Scalling Control register */
-      wr_reg(0x0008,0x0207);     /* Display Control 2 */
-      wr_reg(0x0009,0x0000);     /* Display Control 3 */
-      wr_reg(0x000A,0x0000);     /* Frame Cycle Control */
-      wr_reg(0x000C,0x0000);     /* External Display Interface Control 1 */
-      wr_reg(0x000D,0x0000);      /* Frame Maker Position */
-      wr_reg(0x000F,0x0000);     /* External Display Interface Control 2 */
+      _wr_reg(0x0004,0x0000);     /* Scalling Control register */
+      _wr_reg(0x0008,0x0207);     /* Display Control 2 */
+      _wr_reg(0x0009,0x0000);     /* Display Control 3 */
+      _wr_reg(0x000A,0x0000);     /* Frame Cycle Control */
+      _wr_reg(0x000C,0x0000);     /* External Display Interface Control 1 */
+      _wr_reg(0x000D,0x0000);      /* Frame Maker Position */
+      _wr_reg(0x000F,0x0000);     /* External Display Interface Control 2 */
       delay(50);
-      wr_reg(0x0007,0x0101);     /* Display Control */
+      _wr_reg(0x0007,0x0101);     /* Display Control */
       delay(50);
-      wr_reg(0x0010,0x16B0);      /* Power Control 1 */
-      wr_reg(0x0011,0x0001);      /* Power Control 2 */
-      wr_reg(0x0017,0x0001);      /* Power Control 3 */
-      wr_reg(0x0012,0x0138);      /* Power Control 4 */
-      wr_reg(0x0013,0x0800);      /* Power Control 5 */
-      wr_reg(0x0029,0x0009);     /* NVM read data 2 */
-      wr_reg(0x002a,0x0009);     /* NVM read data 3 */
-      wr_reg(0x00a4,0x0000);  
-      wr_reg(0x0050,0x0000);     /* ÉèÖòÙ×÷´°¿ÚµÄXÖῪʼÁÐ */
-      wr_reg(0x0051,0x00EF);     /* ÉèÖòÙ×÷´°¿ÚµÄXÖá½áÊøÁÐ */
-      wr_reg(0x0052,0x0000);     /* ÉèÖòÙ×÷´°¿ÚµÄYÖῪʼÐÐ */
-      wr_reg(0x0053,0x013F);     /* ÉèÖòÙ×÷´°¿ÚµÄYÖá½áÊøÐÐ */
+      _wr_reg(0x0010,0x16B0);      /* Power Control 1 */
+      _wr_reg(0x0011,0x0001);      /* Power Control 2 */
+      _wr_reg(0x0017,0x0001);      /* Power Control 3 */
+      _wr_reg(0x0012,0x0138);      /* Power Control 4 */
+      _wr_reg(0x0013,0x0800);      /* Power Control 5 */
+      _wr_reg(0x0029,0x0009);     /* NVM read data 2 */
+      _wr_reg(0x002a,0x0009);     /* NVM read data 3 */
+      _wr_reg(0x00a4,0x0000);  
+      _wr_reg(0x0050,0x0000);     /* ÉèÖòÙ×÷´°¿ÚµÄXÖῪʼÁÐ */
+      _wr_reg(0x0051,0x00EF);     /* ÉèÖòÙ×÷´°¿ÚµÄXÖá½áÊøÁÐ */
+      _wr_reg(0x0052,0x0000);     /* ÉèÖòÙ×÷´°¿ÚµÄYÖῪʼÐÐ */
+      _wr_reg(0x0053,0x013F);     /* ÉèÖòÙ×÷´°¿ÚµÄYÖá½áÊøÐÐ */
          
-      wr_reg(0x0060,0x2700);     /* Driver Output Control */
+      _wr_reg(0x0060,0x2700);     /* Driver Output Control */
                                 /* ÉèÖÃÆÁÄ»µÄµãÊýÒÔ¼°É¨ÃèµÄÆðʼÐÐ */
-      wr_reg(0x0061,0x0003);     /* Driver Output Control */
-      wr_reg(0x006A,0x0000);     /* Vertical Scroll Control */
+      _wr_reg(0x0061,0x0003);     /* Driver Output Control */
+      _wr_reg(0x006A,0x0000);     /* Vertical Scroll Control */
       
-      wr_reg(0x0080,0x0000);     /* Display Position ¨C Partial Display 1 */
-      wr_reg(0x0081,0x0000);     /* RAM Address Start ¨C Partial Display 1 */
-      wr_reg(0x0082,0x0000);     /* RAM address End - Partial Display 1 */
-      wr_reg(0x0083,0x0000);     /* Display Position ¨C Partial Display 2 */
-      wr_reg(0x0084,0x0000);     /* RAM Address Start ¨C Partial Display 2 */
-      wr_reg(0x0085,0x0000);     /* RAM address End ¨C Partail Display2 */
-      wr_reg(0x0090,0x0013);     /* Frame Cycle Control */
-      wr_reg(0x0092,0x0000);      /* Panel Interface Control 2 */
-      wr_reg(0x0093,0x0003);     /* Panel Interface control 3 */
-      wr_reg(0x0095,0x0110);     /* Frame Cycle Control */
-      wr_reg(0x0007,0x0173);
+      _wr_reg(0x0080,0x0000);     /* Display Position ¨C Partial Display 1 */
+      _wr_reg(0x0081,0x0000);     /* RAM Address Start ¨C Partial Display 1 */
+      _wr_reg(0x0082,0x0000);     /* RAM address End - Partial Display 1 */
+      _wr_reg(0x0083,0x0000);     /* Display Position ¨C Partial Display 2 */
+      _wr_reg(0x0084,0x0000);     /* RAM Address Start ¨C Partial Display 2 */
+      _wr_reg(0x0085,0x0000);     /* RAM address End ¨C Partail Display2 */
+      _wr_reg(0x0090,0x0013);     /* Frame Cycle Control */
+      _wr_reg(0x0092,0x0000);      /* Panel Interface Control 2 */
+      _wr_reg(0x0093,0x0003);     /* Panel Interface control 3 */
+      _wr_reg(0x0095,0x0110);     /* Frame Cycle Control */
+      _wr_reg(0x0007,0x0173);
 #endif
      break;
    }   
@@ -857,44 +856,44 @@
  
 #ifndef DISABLE_LGDP4531
       /* Setup display */
-      wr_reg(0x00,0x0001);
-      wr_reg(0x10,0x0628);
-      wr_reg(0x12,0x0006);
-      wr_reg(0x13,0x0A32);
-      wr_reg(0x11,0x0040);
-      wr_reg(0x15,0x0050);
-      wr_reg(0x12,0x0016);
+      _wr_reg(0x00,0x0001);
+      _wr_reg(0x10,0x0628);
+      _wr_reg(0x12,0x0006);
+      _wr_reg(0x13,0x0A32);
+      _wr_reg(0x11,0x0040);
+      _wr_reg(0x15,0x0050);
+      _wr_reg(0x12,0x0016);
       delay(50);
-      wr_reg(0x10,0x5660);
+      _wr_reg(0x10,0x5660);
       delay(50);
-      wr_reg(0x13,0x2A4E);
-      wr_reg(0x01,0x0100);
-      wr_reg(0x02,0x0300);   
-      wr_reg(0x03,0x1030);      
-      wr_reg(0x08,0x0202);
-      wr_reg(0x0A,0x0000);
-      wr_reg(0x30,0x0000);
-      wr_reg(0x31,0x0402);
-      wr_reg(0x32,0x0106);
-      wr_reg(0x33,0x0700);
-      wr_reg(0x34,0x0104);
-      wr_reg(0x35,0x0301);
-      wr_reg(0x36,0x0707);
-      wr_reg(0x37,0x0305);
-      wr_reg(0x38,0x0208);
-      wr_reg(0x39,0x0F0B);
+      _wr_reg(0x13,0x2A4E);
+      _wr_reg(0x01,0x0100);
+      _wr_reg(0x02,0x0300);   
+      _wr_reg(0x03,0x1030);      
+      _wr_reg(0x08,0x0202);
+      _wr_reg(0x0A,0x0000);
+      _wr_reg(0x30,0x0000);
+      _wr_reg(0x31,0x0402);
+      _wr_reg(0x32,0x0106);
+      _wr_reg(0x33,0x0700);
+      _wr_reg(0x34,0x0104);
+      _wr_reg(0x35,0x0301);
+      _wr_reg(0x36,0x0707);
+      _wr_reg(0x37,0x0305);
+      _wr_reg(0x38,0x0208);
+      _wr_reg(0x39,0x0F0B);
       delay(50);
-      wr_reg(0x41,0x0002);
-      wr_reg(0x60,0x2700);
-      wr_reg(0x61,0x0001);
-      wr_reg(0x90,0x0119);
-      wr_reg(0x92,0x010A);
-      wr_reg(0x93,0x0004);
-      wr_reg(0xA0,0x0100);
+      _wr_reg(0x41,0x0002);
+      _wr_reg(0x60,0x2700);
+      _wr_reg(0x61,0x0001);
+      _wr_reg(0x90,0x0119);
+      _wr_reg(0x92,0x010A);
+      _wr_reg(0x93,0x0004);
+      _wr_reg(0xA0,0x0100);
       delay(50);
-      wr_reg(0x07,0x0133);
+      _wr_reg(0x07,0x0133);
       delay(50);
-      wr_reg(0xA0,0x0000);
+      _wr_reg(0xA0,0x0000);
 #endif
       break;
    }
@@ -902,45 +901,45 @@
    case LGDP4535_ID: {   
 
 #ifndef DISABLE_LGDP4535
-      wr_reg(0x15, 0x0030);     /* Set the internal vcore voltage */                                              
-      wr_reg(0x9A, 0x0010);     /* Start internal OSC */
-      wr_reg(0x11, 0x0020);        /* set SS and SM bit */
-      wr_reg(0x10, 0x3428);        /* set 1 line inversion */
-      wr_reg(0x12, 0x0002);        /* set GRAM write direction and BGR=1 */ 
-      wr_reg(0x13, 0x1038);        /* Resize register */
+      _wr_reg(0x15, 0x0030);     /* Set the internal vcore voltage */                                              
+      _wr_reg(0x9A, 0x0010);     /* Start internal OSC */
+      _wr_reg(0x11, 0x0020);        /* set SS and SM bit */
+      _wr_reg(0x10, 0x3428);        /* set 1 line inversion */
+      _wr_reg(0x12, 0x0002);        /* set GRAM write direction and BGR=1 */ 
+      _wr_reg(0x13, 0x1038);        /* Resize register */
       delay(40); 
-      wr_reg(0x12, 0x0012);        /* set the back porch and front porch */
+      _wr_reg(0x12, 0x0012);        /* set the back porch and front porch */
       delay(40); 
-      wr_reg(0x10, 0x3420);        /* set non-display area refresh cycle ISC[3:0] */
-      wr_reg(0x13, 0x3045);        /* FMARK function */
+      _wr_reg(0x10, 0x3420);        /* set non-display area refresh cycle ISC[3:0] */
+      _wr_reg(0x13, 0x3045);        /* FMARK function */
       delay(70); 
-      wr_reg(0x30, 0x0000);      /* RGB interface setting */
-      wr_reg(0x31, 0x0402);        /* Frame marker Position */
-      wr_reg(0x32, 0x0307);      /* RGB interface polarity */
-      wr_reg(0x33, 0x0304);      /* SAP, BT[3:0], AP, DSTB, SLP, STB */
-      wr_reg(0x34, 0x0004);      /* DC1[2:0], DC0[2:0], VC[2:0] */
-      wr_reg(0x35, 0x0401);      /* VREG1OUT voltage */
-      wr_reg(0x36, 0x0707);      /* VDV[4:0] for VCOM amplitude */
-      wr_reg(0x37, 0x0305);      /* SAP, BT[3:0], AP, DSTB, SLP, STB */
-      wr_reg(0x38, 0x0610);      /* DC1[2:0], DC0[2:0], VC[2:0] */
-      wr_reg(0x39, 0x0610);      /* VREG1OUT voltage */
-      wr_reg(0x01, 0x0100);      /* VDV[4:0] for VCOM amplitude */
-      wr_reg(0x02, 0x0300);      /* VCM[4:0] for VCOMH */
-      wr_reg(0x03, 0x1030);      /* GRAM horizontal Address */
-      wr_reg(0x08, 0x0808);      /* GRAM Vertical Address */
-      wr_reg(0x0A, 0x0008);      
-      wr_reg(0x60, 0x2700);        /* Gate Scan Line */
-      wr_reg(0x61, 0x0001);        /* NDL,VLE, REV */
-      wr_reg(0x90, 0x013E);
-      wr_reg(0x92, 0x0100);
-      wr_reg(0x93, 0x0100);
-      wr_reg(0xA0, 0x3000);
-      wr_reg(0xA3, 0x0010);
-      wr_reg(0x07, 0x0001);
-      wr_reg(0x07, 0x0021);
-      wr_reg(0x07, 0x0023);
-      wr_reg(0x07, 0x0033);
-      wr_reg(0x07, 0x0133);
+      _wr_reg(0x30, 0x0000);      /* RGB interface setting */
+      _wr_reg(0x31, 0x0402);        /* Frame marker Position */
+      _wr_reg(0x32, 0x0307);      /* RGB interface polarity */
+      _wr_reg(0x33, 0x0304);      /* SAP, BT[3:0], AP, DSTB, SLP, STB */
+      _wr_reg(0x34, 0x0004);      /* DC1[2:0], DC0[2:0], VC[2:0] */
+      _wr_reg(0x35, 0x0401);      /* VREG1OUT voltage */
+      _wr_reg(0x36, 0x0707);      /* VDV[4:0] for VCOM amplitude */
+      _wr_reg(0x37, 0x0305);      /* SAP, BT[3:0], AP, DSTB, SLP, STB */
+      _wr_reg(0x38, 0x0610);      /* DC1[2:0], DC0[2:0], VC[2:0] */
+      _wr_reg(0x39, 0x0610);      /* VREG1OUT voltage */
+      _wr_reg(0x01, 0x0100);      /* VDV[4:0] for VCOM amplitude */
+      _wr_reg(0x02, 0x0300);      /* VCM[4:0] for VCOMH */
+      _wr_reg(0x03, 0x1030);      /* GRAM horizontal Address */
+      _wr_reg(0x08, 0x0808);      /* GRAM Vertical Address */
+      _wr_reg(0x0A, 0x0008);      
+      _wr_reg(0x60, 0x2700);        /* Gate Scan Line */
+      _wr_reg(0x61, 0x0001);        /* NDL,VLE, REV */
+      _wr_reg(0x90, 0x013E);
+      _wr_reg(0x92, 0x0100);
+      _wr_reg(0x93, 0x0100);
+      _wr_reg(0xA0, 0x3000);
+      _wr_reg(0xA3, 0x0010);
+      _wr_reg(0x07, 0x0001);
+      _wr_reg(0x07, 0x0021);
+      _wr_reg(0x07, 0x0023);
+      _wr_reg(0x07, 0x0033);
+      _wr_reg(0x07, 0x0133);
 #endif
       break;
    }    
@@ -949,65 +948,65 @@
  
  #ifndef DISABLE_HX8347D
       /* Start Initial Sequence */
-      wr_reg(0xEA,0x00);                          
-      wr_reg(0xEB,0x20);                                                     
-      wr_reg(0xEC,0x0C);                                                   
-      wr_reg(0xED,0xC4);                                                    
-      wr_reg(0xE8,0x40);                                                     
-      wr_reg(0xE9,0x38);                                                    
-      wr_reg(0xF1,0x01);                                                    
-      wr_reg(0xF2,0x10);                                                    
-      wr_reg(0x27,0xA3);                                                    
+      _wr_reg(0xEA,0x00);                          
+      _wr_reg(0xEB,0x20);                                                     
+      _wr_reg(0xEC,0x0C);                                                   
+      _wr_reg(0xED,0xC4);                                                    
+      _wr_reg(0xE8,0x40);                                                     
+      _wr_reg(0xE9,0x38);                                                    
+      _wr_reg(0xF1,0x01);                                                    
+      _wr_reg(0xF2,0x10);                                                    
+      _wr_reg(0x27,0xA3);                                                    
       /* GAMMA SETTING */
-      wr_reg(0x40,0x01);                           
-      wr_reg(0x41,0x00);                                                   
-      wr_reg(0x42,0x00);                                                   
-      wr_reg(0x43,0x10);                                                    
-      wr_reg(0x44,0x0E);                                                   
-      wr_reg(0x45,0x24);                                                  
-      wr_reg(0x46,0x04);                                                  
-      wr_reg(0x47,0x50);                                                   
-      wr_reg(0x48,0x02);                                                    
-      wr_reg(0x49,0x13);                                                  
-      wr_reg(0x4A,0x19);                                                  
-      wr_reg(0x4B,0x19);                                                 
-      wr_reg(0x4C,0x16);                                                 
-      wr_reg(0x50,0x1B);                                                   
-      wr_reg(0x51,0x31);                                                    
-      wr_reg(0x52,0x2F);                                                     
-      wr_reg(0x53,0x3F);                                                    
-      wr_reg(0x54,0x3F);                                                     
-      wr_reg(0x55,0x3E);                                                     
-      wr_reg(0x56,0x2F);                                                   
-      wr_reg(0x57,0x7B);                                                     
-      wr_reg(0x58,0x09);                                                  
-      wr_reg(0x59,0x06);                                                 
-      wr_reg(0x5A,0x06);                                                   
-      wr_reg(0x5B,0x0C);                                                   
-      wr_reg(0x5C,0x1D);                                                   
-      wr_reg(0x5D,0xCC);                                                   
+      _wr_reg(0x40,0x01);                           
+      _wr_reg(0x41,0x00);                                                   
+      _wr_reg(0x42,0x00);                                                   
+      _wr_reg(0x43,0x10);                                                    
+      _wr_reg(0x44,0x0E);                                                   
+      _wr_reg(0x45,0x24);                                                  
+      _wr_reg(0x46,0x04);                                                  
+      _wr_reg(0x47,0x50);                                                   
+      _wr_reg(0x48,0x02);                                                    
+      _wr_reg(0x49,0x13);                                                  
+      _wr_reg(0x4A,0x19);                                                  
+      _wr_reg(0x4B,0x19);                                                 
+      _wr_reg(0x4C,0x16);                                                 
+      _wr_reg(0x50,0x1B);                                                   
+      _wr_reg(0x51,0x31);                                                    
+      _wr_reg(0x52,0x2F);                                                     
+      _wr_reg(0x53,0x3F);                                                    
+      _wr_reg(0x54,0x3F);                                                     
+      _wr_reg(0x55,0x3E);                                                     
+      _wr_reg(0x56,0x2F);                                                   
+      _wr_reg(0x57,0x7B);                                                     
+      _wr_reg(0x58,0x09);                                                  
+      _wr_reg(0x59,0x06);                                                 
+      _wr_reg(0x5A,0x06);                                                   
+      _wr_reg(0x5B,0x0C);                                                   
+      _wr_reg(0x5C,0x1D);                                                   
+      _wr_reg(0x5D,0xCC);                                                   
       /* Power Voltage Setting */
-      wr_reg(0x1B,0x18);                                                    
-      wr_reg(0x1A,0x01);                                                    
-      wr_reg(0x24,0x15);                                                    
-      wr_reg(0x25,0x50);                                                    
-      wr_reg(0x23,0x8B);                                                   
-      wr_reg(0x18,0x36);                           
-      wr_reg(0x19,0x01);                                                    
-      wr_reg(0x01,0x00);                                                   
-      wr_reg(0x1F,0x88);                                                    
+      _wr_reg(0x1B,0x18);                                                    
+      _wr_reg(0x1A,0x01);                                                    
+      _wr_reg(0x24,0x15);                                                    
+      _wr_reg(0x25,0x50);                                                    
+      _wr_reg(0x23,0x8B);                                                   
+      _wr_reg(0x18,0x36);                           
+      _wr_reg(0x19,0x01);                                                    
+      _wr_reg(0x01,0x00);                                                   
+      _wr_reg(0x1F,0x88);                                                    
       delay(50);
-      wr_reg(0x1F,0x80);                                                  
+      _wr_reg(0x1F,0x80);                                                  
       delay(50);
-      wr_reg(0x1F,0x90);                                                   
+      _wr_reg(0x1F,0x90);                                                   
       delay(50);
-      wr_reg(0x1F,0xD0);                                                   
+      _wr_reg(0x1F,0xD0);                                                   
       delay(50);
-      wr_reg(0x17,0x05);                                                    
-      wr_reg(0x36,0x00);                                                    
-      wr_reg(0x28,0x38);                                                 
+      _wr_reg(0x17,0x05);                                                    
+      _wr_reg(0x36,0x00);                                                    
+      _wr_reg(0x28,0x38);                                                 
       delay(50);
-      wr_reg(0x28,0x3C); 
+      _wr_reg(0x28,0x3C); 
 #endif
       break;
    }
@@ -1016,49 +1015,49 @@
  
 #ifndef DISABLE_ST7781
       /* Start Initial Sequence */
-      wr_reg(0x00FF,0x0001);
-      wr_reg(0x00F3,0x0008);
-      wr_reg(0x0001,0x0100);
-      wr_reg(0x0002,0x0700);
-      wr_reg(0x0003,0x1030);  
-      wr_reg(0x0008,0x0302);
-      wr_reg(0x0008,0x0207);
-      wr_reg(0x0009,0x0000);
-      wr_reg(0x000A,0x0000);
-      wr_reg(0x0010,0x0000);  
-      wr_reg(0x0011,0x0005);
-      wr_reg(0x0012,0x0000);
-      wr_reg(0x0013,0x0000);
+      _wr_reg(0x00FF,0x0001);
+      _wr_reg(0x00F3,0x0008);
+      _wr_reg(0x0001,0x0100);
+      _wr_reg(0x0002,0x0700);
+      _wr_reg(0x0003,0x1030);  
+      _wr_reg(0x0008,0x0302);
+      _wr_reg(0x0008,0x0207);
+      _wr_reg(0x0009,0x0000);
+      _wr_reg(0x000A,0x0000);
+      _wr_reg(0x0010,0x0000);  
+      _wr_reg(0x0011,0x0005);
+      _wr_reg(0x0012,0x0000);
+      _wr_reg(0x0013,0x0000);
       delay(50);
-      wr_reg(0x0010,0x12B0);
+      _wr_reg(0x0010,0x12B0);
       delay(50);
-      wr_reg(0x0011,0x0007);
+      _wr_reg(0x0011,0x0007);
       delay(50);
-      wr_reg(0x0012,0x008B);
+      _wr_reg(0x0012,0x008B);
       delay(50);   
-      wr_reg(0x0013,0x1700);
+      _wr_reg(0x0013,0x1700);
       delay(50);   
-      wr_reg(0x0029,0x0022);      
-      wr_reg(0x0030,0x0000);
-      wr_reg(0x0031,0x0707);
-      wr_reg(0x0032,0x0505);
-      wr_reg(0x0035,0x0107);
-      wr_reg(0x0036,0x0008);
-      wr_reg(0x0037,0x0000);
-      wr_reg(0x0038,0x0202);
-      wr_reg(0x0039,0x0106);
-      wr_reg(0x003C,0x0202);
-      wr_reg(0x003D,0x0408);
+      _wr_reg(0x0029,0x0022);      
+      _wr_reg(0x0030,0x0000);
+      _wr_reg(0x0031,0x0707);
+      _wr_reg(0x0032,0x0505);
+      _wr_reg(0x0035,0x0107);
+      _wr_reg(0x0036,0x0008);
+      _wr_reg(0x0037,0x0000);
+      _wr_reg(0x0038,0x0202);
+      _wr_reg(0x0039,0x0106);
+      _wr_reg(0x003C,0x0202);
+      _wr_reg(0x003D,0x0408);
       delay(50);            
-      wr_reg(0x0050,0x0000);      
-      wr_reg(0x0051,0x00EF);      
-      wr_reg(0x0052,0x0000);      
-      wr_reg(0x0053,0x013F);      
-      wr_reg(0x0060,0xA700);      
-      wr_reg(0x0061,0x0001);
-      wr_reg(0x0090,0x0033);            
-      wr_reg(0x002B,0x000B);      
-      wr_reg(0x0007,0x0133);
+      _wr_reg(0x0050,0x0000);      
+      _wr_reg(0x0051,0x00EF);      
+      _wr_reg(0x0052,0x0000);      
+      _wr_reg(0x0053,0x013F);      
+      _wr_reg(0x0060,0xA700);      
+      _wr_reg(0x0061,0x0001);
+      _wr_reg(0x0090,0x0033);            
+      _wr_reg(0x002B,0x000B);      
+      _wr_reg(0x0007,0x0133);
 #endif
       break;
    }
@@ -1066,88 +1065,88 @@
 
   default: {
       /* special ID */
-      _driverCode = rd_reg(0x67);
+      _driverCode = _rd_reg(0x67);
       
       if (_driverCode == HX8347A_ID) {
 
 #ifndef DISABLE_HX8347A
-        wr_reg(0x0042,0x0008);
+        _wr_reg(0x0042,0x0008);
         /* Gamma setting */
-        wr_reg(0x0046,0x00B4);
-        wr_reg(0x0047,0x0043);
-        wr_reg(0x0048,0x0013);
-        wr_reg(0x0049,0x0047);
-        wr_reg(0x004A,0x0014);
-        wr_reg(0x004B,0x0036);
-        wr_reg(0x004C,0x0003);
-        wr_reg(0x004D,0x0046);
-        wr_reg(0x004E,0x0005);
-        wr_reg(0x004F,0x0010);
-        wr_reg(0x0050,0x0008);
-        wr_reg(0x0051,0x000a);
+        _wr_reg(0x0046,0x00B4);
+        _wr_reg(0x0047,0x0043);
+        _wr_reg(0x0048,0x0013);
+        _wr_reg(0x0049,0x0047);
+        _wr_reg(0x004A,0x0014);
+        _wr_reg(0x004B,0x0036);
+        _wr_reg(0x004C,0x0003);
+        _wr_reg(0x004D,0x0046);
+        _wr_reg(0x004E,0x0005);
+        _wr_reg(0x004F,0x0010);
+        _wr_reg(0x0050,0x0008);
+        _wr_reg(0x0051,0x000a);
         /* Window Setting */
-        wr_reg(0x0002,0x0000);
-        wr_reg(0x0003,0x0000);
-        wr_reg(0x0004,0x0000);
-        wr_reg(0x0005,0x00EF);
-        wr_reg(0x0006,0x0000);
-        wr_reg(0x0007,0x0000);
-        wr_reg(0x0008,0x0001);
-        wr_reg(0x0009,0x003F);
+        _wr_reg(0x0002,0x0000);
+        _wr_reg(0x0003,0x0000);
+        _wr_reg(0x0004,0x0000);
+        _wr_reg(0x0005,0x00EF);
+        _wr_reg(0x0006,0x0000);
+        _wr_reg(0x0007,0x0000);
+        _wr_reg(0x0008,0x0001);
+        _wr_reg(0x0009,0x003F);
         delay(10);
-        wr_reg(0x0001,0x0006);
-        wr_reg(0x0016,0x00C8);
-        wr_reg(0x0023,0x0095);
-        wr_reg(0x0024,0x0095);
-        wr_reg(0x0025,0x00FF);
-        wr_reg(0x0027,0x0002);
-        wr_reg(0x0028,0x0002);
-        wr_reg(0x0029,0x0002);
-        wr_reg(0x002A,0x0002);
-        wr_reg(0x002C,0x0002);
-        wr_reg(0x002D,0x0002);
-        wr_reg(0x003A,0x0001);
-        wr_reg(0x003B,0x0001);
-        wr_reg(0x003C,0x00F0);
-        wr_reg(0x003D,0x0000);
+        _wr_reg(0x0001,0x0006);
+        _wr_reg(0x0016,0x00C8);
+        _wr_reg(0x0023,0x0095);
+        _wr_reg(0x0024,0x0095);
+        _wr_reg(0x0025,0x00FF);
+        _wr_reg(0x0027,0x0002);
+        _wr_reg(0x0028,0x0002);
+        _wr_reg(0x0029,0x0002);
+        _wr_reg(0x002A,0x0002);
+        _wr_reg(0x002C,0x0002);
+        _wr_reg(0x002D,0x0002);
+        _wr_reg(0x003A,0x0001);
+        _wr_reg(0x003B,0x0001);
+        _wr_reg(0x003C,0x00F0);
+        _wr_reg(0x003D,0x0000);
         delay(20);
-        wr_reg(0x0035,0x0038);
-        wr_reg(0x0036,0x0078);
-        wr_reg(0x003E,0x0038);
-        wr_reg(0x0040,0x000F);
-        wr_reg(0x0041,0x00F0);
-        wr_reg(0x0038,0x0000);
+        _wr_reg(0x0035,0x0038);
+        _wr_reg(0x0036,0x0078);
+        _wr_reg(0x003E,0x0038);
+        _wr_reg(0x0040,0x000F);
+        _wr_reg(0x0041,0x00F0);
+        _wr_reg(0x0038,0x0000);
         /* Power Setting */
-        wr_reg(0x0019,0x0049);
-        wr_reg(0x0093,0x000A);
+        _wr_reg(0x0019,0x0049);
+        _wr_reg(0x0093,0x000A);
         delay(10);
-        wr_reg(0x0020,0x0020);
-        wr_reg(0x001D,0x0003);
-        wr_reg(0x001E,0x0000);
-        wr_reg(0x001F,0x0009);
-        wr_reg(0x0044,0x0053);
-        wr_reg(0x0045,0x0010);
+        _wr_reg(0x0020,0x0020);
+        _wr_reg(0x001D,0x0003);
+        _wr_reg(0x001E,0x0000);
+        _wr_reg(0x001F,0x0009);
+        _wr_reg(0x0044,0x0053);
+        _wr_reg(0x0045,0x0010);
         delay(10);
-        wr_reg(0x001C,0x0004);
+        _wr_reg(0x001C,0x0004);
         delay(20);
-        wr_reg(0x0043,0x0080);
+        _wr_reg(0x0043,0x0080);
         delay(5);
-        wr_reg(0x001B,0x000a);
+        _wr_reg(0x001B,0x000a);
         delay(40);
-        wr_reg(0x001B,0x0012);
+        _wr_reg(0x001B,0x0012);
         delay(40);
         /* Display On Setting */
-        wr_reg(0x0090,0x007F);
-        wr_reg(0x0026,0x0004);
+        _wr_reg(0x0090,0x007F);
+        _wr_reg(0x0026,0x0004);
         delay(40);
-        wr_reg(0x0026,0x0024);
-        wr_reg(0x0026,0x002C);
+        _wr_reg(0x0026,0x0024);
+        _wr_reg(0x0026,0x002C);
         delay(40);
-        wr_reg(0x0070,0x0008);
-        wr_reg(0x0026,0x003C); 
-        wr_reg(0x0057,0x0002);
-        wr_reg(0x0055,0x0000);
-        wr_reg(0x0057,0x0000);
+        _wr_reg(0x0070,0x0008);
+        _wr_reg(0x0026,0x003C); 
+        _wr_reg(0x0057,0x0002);
+        _wr_reg(0x0055,0x0000);
+        _wr_reg(0x0057,0x0000);
 #endif        
      } // if
 
@@ -1177,7 +1176,7 @@
 *   Parameter:                                                                 *
 *   Return: short Controller ID                                                *
 *******************************************************************************/
-unsigned short GLCD::getDriverCode () {
+uint16_t GLCD::getDriverCode () {
 
   return (_driverCode);
 }
@@ -1189,21 +1188,21 @@
 *   Return:                                                                    *
 *******************************************************************************/
 
-void GLCD::WindowMax (void) {
+void GLCD::setWindowMax (void) {
   
   if(_driverCode==SSD1289_ID)
   {
-    wr_reg(0x44, 0);                      /* Horizontal GRAM Start Address      */
-    wr_reg(0x44, 0 |((HEIGHT-1)<<8));     /* Horizontal GRAM End   Address (-1) */
-    wr_reg(0x45, 0);                      /* Vertical   GRAM Start Address      */
-    wr_reg(0x46, WIDTH-1);                /* Vertical   GRAM End   Address (-1) */
+    _wr_reg(0x44, 0);                      /* Horizontal GRAM Start Address      */
+    _wr_reg(0x44, 0 |((HEIGHT-1)<<8));     /* Horizontal GRAM End   Address (-1) */
+    _wr_reg(0x45, 0);                      /* Vertical   GRAM Start Address      */
+    _wr_reg(0x46, WIDTH-1);                /* Vertical   GRAM End   Address (-1) */
   }
   else
   {
-      wr_reg(0x50, 0);                      /* Horizontal GRAM Start Address      */
-      wr_reg(0x51, HEIGHT-1);               /* Horizontal GRAM End   Address (-1) */
-      wr_reg(0x52, 0);                      /* Vertical   GRAM Start Address      */
-      wr_reg(0x53, WIDTH-1);                /* Vertical   GRAM End   Address (-1) */
+      _wr_reg(0x50, 0);                      /* Horizontal GRAM Start Address      */
+      _wr_reg(0x51, HEIGHT-1);               /* Horizontal GRAM End   Address (-1) */
+      _wr_reg(0x52, 0);                      /* Vertical   GRAM Start Address      */
+      _wr_reg(0x53, WIDTH-1);                /* Vertical   GRAM End   Address (-1) */
   }
 }
 
@@ -1213,27 +1212,27 @@
 *   Return:                                                                    *
 *******************************************************************************/
 
-void GLCD::Window (int x1, int y1, int x2, int y2) {
+void GLCD::setWindow (int x1, int y1, int x2, int y2) {
   
   if(_driverCode==SSD1289_ID)
   {
-//    wr_reg(0x44, x1);                     /* Horizontal GRAM Start Address */
-//    wr_reg(0x44, 0 | (x2<<8));            /* Horizontal GRAM End Address   */
+//    _wr_reg(0x44, x1);                     /* Horizontal GRAM Start Address */
+//    _wr_reg(0x44, 0 | (x2<<8));            /* Horizontal GRAM End Address   */
 
 //Note x,y flipped for landscape  
-    wr_reg(0x44, ((y2 & 0xFF) <<8) | (y1 & 0xFF)); /* Horizontal GRAM End Address | Start Address  */    
-    wr_reg(0x45, x1);                     /* Vertical GRAM Start Address   */
-    wr_reg(0x46, x2);                     /* Vertical GRAM End Address     */
+    _wr_reg(0x44, ((y2 & 0xFF) <<8) | (y1 & 0xFF)); /* Horizontal GRAM End Address | Start Address  */    
+    _wr_reg(0x45, x1);                     /* Vertical GRAM Start Address   */
+    _wr_reg(0x46, x2);                     /* Vertical GRAM End Address     */
     
-    wr_reg(0x4e, y1);                     // Init x,y to start of window
-    wr_reg(0x4f, x1);    
+    _wr_reg(0x4e, y1);                     // Init x,y to start of window
+    _wr_reg(0x4f, x1);    
   }
   else
   {
-      wr_reg(0x50, x1);                   /* Horizontal GRAM Start Address */
-      wr_reg(0x51, x2);                   /* Horizontal GRAM End   Address */
-      wr_reg(0x52, y1);                   /* Vertical   GRAM Start Address */
-      wr_reg(0x53, y2);                   /* Vertical   GRAM End   Address */
+      _wr_reg(0x50, x1);                   /* Horizontal GRAM Start Address */
+      _wr_reg(0x51, x2);                   /* Horizontal GRAM End   Address */
+      _wr_reg(0x52, y1);                   /* Vertical   GRAM Start Address */
+      _wr_reg(0x53, y2);                   /* Vertical   GRAM End   Address */
   }
 }
 
@@ -1248,64 +1247,65 @@
   // Set Cursor
   if(_driverCode==SSD1289_ID)
   {
-      wr_reg(0x4e, y);
-//      wr_reg(0x4f, WIDTH-1-x);
-      wr_reg(0x4f, x);      
+      _wr_reg(0x4e, y);
+//      _wr_reg(0x4f, WIDTH-1-x);
+      _wr_reg(0x4f, x);      
   }
   else
   {
-      wr_reg(0x20, y);
-//      wr_reg(0x21, WIDTH-1-x);
-      wr_reg(0x21, x);      
+      _wr_reg(0x20, y);
+//      _wr_reg(0x21, WIDTH-1-x);
+      _wr_reg(0x21, x);      
   }
   LCD_CS(0)
-  wr_cmd(0x22);
-  wr_dat(_textColor);
+  _wr_cmd(0x22);
+  _wr_dat(_textColor);
   LCD_CS(1)
 }
 
-void GLCD::drawPixel (unsigned int x, unsigned int y, unsigned short color) 
+void GLCD::drawPixel (unsigned int x, unsigned int y, uint16_t color) 
 {
   // Set Cursor
   if(_driverCode==SSD1289_ID)
   {
-      wr_reg(0x4e, y);
-      wr_reg(0x4f, WIDTH-1-x);
+      _wr_reg(0x4e, y);
+//      _wr_reg(0x4f, WIDTH-1-x);
+      _wr_reg(0x4f, x);      
   }
   else
   {
-      wr_reg(0x20, y);
-      wr_reg(0x21, WIDTH-1-x);
+      _wr_reg(0x20, y);
+      _wr_reg(0x21, WIDTH-1-x);
   }
   LCD_CS(0)
-  wr_cmd(0x22);
-  wr_dat(color);
+  _wr_cmd(0x22);
+  _wr_dat(color);
   LCD_CS(1)
 }
 
 
 void GLCD::drawPixel (unsigned int x, unsigned int y, uint8_t r, uint8_t g, uint8_t b) 
 {
-//  unsigned short color = ((r & 0xF8)<<8) | ((g & 0xFC)<<3) | ((b & 0xF8)>>3);    // rrrrrggggggbbbbb
-  unsigned short color = RGB24toRGB16(r,g,b);
+//  uint16_t color = ((r & 0xF8)<<8) | ((g & 0xFC)<<3) | ((b & 0xF8)>>3);    // rrrrrggggggbbbbb
+  uint16_t color = RGB24toRGB16(r,g,b);
 
 
   // Set Cursor
   if(_driverCode==SSD1289_ID)
   {
-      wr_reg(0x4e, y);
-//      wr_reg(0x4f, WIDTH-1-x);
-      wr_reg(0x4f, x);      
+      _wr_reg(0x4e, y);
+//      _wr_reg(0x4f, WIDTH-1-x);
+      _wr_reg(0x4f, x);      
   }
   else
   {
-      wr_reg(0x20, y);
-//      wr_reg(0x21, WIDTH-1-x);
-      wr_reg(0x21, x);      
+      _wr_reg(0x20, y);
+//      _wr_reg(0x21, WIDTH-1-x);
+      _wr_reg(0x21, x);      
   }
   LCD_CS(0)
-  wr_cmd(0x22);
-  wr_dat(color);
+  _wr_cmd(0x22);
+  _wr_dat(color);
   LCD_CS(1)
 }
 
@@ -1318,13 +1318,13 @@
 *   Return:                                                                    *
 *******************************************************************************/
 
-void GLCD::setColor (unsigned short color) {
+void GLCD::setColor (uint16_t color) {
 
   _textColor = color;
 }
 
 void GLCD::setColor (uint8_t r, uint8_t g, uint8_t b) {     
-  unsigned short color = RGB24toRGB16(r,g,b);
+  uint16_t color = RGB24toRGB16(r,g,b);
   
   _textColor = color;
 }
@@ -1339,14 +1339,14 @@
 *   Return:                                                                    *
 *******************************************************************************/
 
-void GLCD::setBackColor (unsigned short color) {
+void GLCD::setBackColor (uint16_t color) {
 
   _backColor = color;
 }
 
 
 void GLCD::setBackColor (uint8_t r, uint8_t g, uint8_t b) {     
-  unsigned short color = RGB24toRGB16(r,g,b);
+  uint16_t color = RGB24toRGB16(r,g,b);
   
   _backColor = color;
 }
@@ -1358,28 +1358,28 @@
 *   Return:                                                                    *
 *******************************************************************************/
 
-void GLCD::clearScreen (unsigned short color) {
+void GLCD::clearScreen (uint16_t color) {
   unsigned int   i;
 
-  WindowMax();
+  setWindowMax();
   
   // Set Cursor
   if (_driverCode==SSD1289_ID)
   {
-      wr_reg(0x4e, 0);
-      wr_reg(0x4f, 0);
+      _wr_reg(0x4e, 0);
+      _wr_reg(0x4f, 0);
   }
   else
   {
-      wr_reg(0x20, 0);
-      wr_reg(0x21, 0);
+      _wr_reg(0x20, 0);
+      _wr_reg(0x21, 0);
   }
   LCD_CS(0)
-  wr_cmd(0x22);
-  wr_dat_start();
+  _wr_cmd(0x22);
+  _wr_dat_start();
   for(i = 0; i < (WIDTH*HEIGHT); i++)
-    wr_dat_only(color);
-  wr_dat_stop();
+    _wr_dat_only(color);
+  _wr_dat_stop();
 }
 
 
@@ -1391,46 +1391,46 @@
 *   Return:                                                                    *
 *******************************************************************************/
 
-void GLCD::DrawChar (unsigned int x, unsigned int y, unsigned short *c) {
+void GLCD::DrawChar (unsigned int x, unsigned int y, uint16_t *c) {
   int idx = 0, i, j;
 
 //wh  x = WIDTH-x-CHAR_W;
 
   if(_driverCode==SSD1289_ID)
   {
-//wh    wr_reg(0x44, y);                      /* Horizontal GRAM Start Address      */
-    wr_reg(0x44, y |((y+CHAR_H-1)<<8));   /* Horizontal GRAM End   Address (-1) */
-    wr_reg(0x45, x);                      /* Vertical   GRAM Start Address      */
-    wr_reg(0x46, x+CHAR_W-1);             /* Vertical   GRAM End   Address (-1) */
+//wh    _wr_reg(0x44, y);                      /* Horizontal GRAM Start Address      */
+    _wr_reg(0x44, y |((y+CHAR_H-1)<<8));   /* Horizontal GRAM End   Address (-1) */
+    _wr_reg(0x45, x);                      /* Vertical   GRAM Start Address      */
+    _wr_reg(0x46, x+CHAR_W-1);             /* Vertical   GRAM End   Address (-1) */
 
-    wr_reg(0x4e, y);
-    wr_reg(0x4f, x);
+    _wr_reg(0x4e, y);
+    _wr_reg(0x4f, x);
   }
   else
   {
-      wr_reg(0x50, y);                      /* Horizontal GRAM Start Address      */
-      wr_reg(0x51, y+CHAR_H-1);             /* Horizontal GRAM End   Address (-1) */
-      wr_reg(0x52, x);                      /* Vertical   GRAM Start Address      */
-      wr_reg(0x53, x+CHAR_W-1);             /* Vertical   GRAM End   Address (-1) */
+      _wr_reg(0x50, y);                      /* Horizontal GRAM Start Address      */
+      _wr_reg(0x51, y+CHAR_H-1);             /* Horizontal GRAM End   Address (-1) */
+      _wr_reg(0x52, x);                      /* Vertical   GRAM Start Address      */
+      _wr_reg(0x53, x+CHAR_W-1);             /* Vertical   GRAM End   Address (-1) */
 
-      wr_reg(0x20, y);
-      wr_reg(0x21, x);
+      _wr_reg(0x20, y);
+      _wr_reg(0x21, x);
   }
   LCD_CS(0)
-  wr_cmd(0x22);
-  wr_dat_start();
+  _wr_cmd(0x22);
+  _wr_dat_start();
   for (j = 0; j < CHAR_H; j++) {
 //wh    for (i = CHAR_W-1; i >= 0; i--) {
     for (i = 0; i < CHAR_W; i++) {    
       if((c[idx] & (1 << i)) == 0x00) {
-        wr_dat_only(_backColor);
+        _wr_dat_only(_backColor);
       } else {
-        wr_dat_only(_textColor);
+        _wr_dat_only(_textColor);
       }
     }
     c++;
   }
-  wr_dat_stop();
+  _wr_dat_stop();
 }
 
 
@@ -1442,11 +1442,11 @@
 *   Return:                                                                    *
 *******************************************************************************/
 
-void GLCD::DisplayChar (unsigned int ln, unsigned int col, unsigned char c) {
+void GLCD::DisplayChar (uint16_t ln, uint16_t col, uint8_t c) {
 
   c -= 32;
   // x = column, y = line
-  DrawChar(col * CHAR_W, ln * CHAR_H, (unsigned short *)&Font_24x16[c * CHAR_H]);
+  DrawChar(col * CHAR_W, ln * CHAR_H, (uint16_t *)&Font_24x16[c * CHAR_H]);
 
 }
 
@@ -1459,9 +1459,9 @@
 *   Return:                                                                    *
 *******************************************************************************/
 
-void GLCD::DisplayString (unsigned int ln, unsigned int col, unsigned char *s) {
+void GLCD::DisplayString (uint16_t ln, uint16_t col, uint8_t *s) {
 
-  WindowMax();
+  setWindowMax();
   while (*s) {
     DisplayChar(ln, col++, *s++);
   }
@@ -1474,10 +1474,10 @@
 *   Return:                                                                    *
 *******************************************************************************/
 
-void GLCD::ClearLn (unsigned int ln) {
+void GLCD::ClearLn (uint16_t ln) {
 
-  WindowMax();
-  DisplayString(ln, 0, (unsigned char*) "                    ");
+  setWindowMax();
+  DisplayString(ln, 0, (uint8_t*) "                    ");
 }
 
 //SSD1289
@@ -1488,6 +1488,24 @@
 //}
 
 
+
+/** @brief Write single character to the display using the 8x8 fontable
+ *  @brief Start at current cursor location
+ *  @param char chr character to write
+*/
+void GLCD::writeChar(uint8_t chr) {
+  const uint8_t char_index = chr - 0x20;
+
+//  for (uint8_t i = 0; i < 8; i++) {
+//    _sendData( font_8x8[char_index][i] );
+//  }
+
+  // x = column, y = line
+  DrawChar(_col * CHAR_W, _ln * CHAR_H, (uint16_t *)&Font_24x16[chr * CHAR_H]);
+  _col++;
+  
+}
+
 void GLCD::drawHLine(int x, int y, int l)
 {
 //    char ch, cl;
@@ -1497,7 +1515,7 @@
 
 //    cbi(P_CS, B_CS);
 
-    Window (x, y, x+l, y);
+    setWindow (x, y, x+l, y);
     
 //    for (int i=0; i<l+1; i++)
 //    {
@@ -1505,16 +1523,16 @@
 //    }
 
     LCD_CS(0)
-    wr_cmd(0x22);
+    _wr_cmd(0x22);
  
-    wr_dat_start();
+    _wr_dat_start();
     for (int i=0; i<l; i++)    
-      wr_dat_only(_textColor);
-    wr_dat_stop();
+      _wr_dat_only(_textColor);
+    _wr_dat_stop();
    
 //    sbi(P_CS, B_CS);
 //    clrXY();
-    WindowMax();
+    setWindowMax();
 }
 
 void GLCD::drawVLine(int x, int y, int l)
@@ -1525,23 +1543,23 @@
 //    cl=((fcolorg&28)<<3|fcolorb>>3);
 
 //    cbi(P_CS, B_CS);
-    Window(x, y, x, y+l);
+    setWindow(x, y, x, y+l);
 //    for (int i=0; i<l; i++)
 //    {
-//        GLCD::wr_dat(ch, cl);
+//        GLCD::_wr_dat(ch, cl);
 //    }
     LCD_CS(0)
-    wr_cmd(0x22);
+    _wr_cmd(0x22);
 
-    wr_dat_start();
+    _wr_dat_start();
     for (int i=0; i<l; i++)    
-      wr_dat_only(_textColor);
-    wr_dat_stop();
+      _wr_dat_only(_textColor);
+    _wr_dat_stop();
 
 
 //    sbi(P_CS, B_CS);
 //    clrXY();
-    WindowMax();    
+    setWindowMax();    
 }
 
 
@@ -1644,7 +1662,7 @@
         }
     }
 
-    WindowMax();
+    setWindowMax();
 }
 
 void GLCD::drawRoundRect(int x1, int y1, int x2, int y2)
@@ -1806,17 +1824,18 @@
 }
 
 
-
-
+//not yet checked
 void GLCD::lcdOff()
 {
+  _wr_reg(0x0007, 0x0000); 
 }
 
 void GLCD::lcdOn()
 {
+  _wr_reg(0x0007, 0x0173); 
 }
 
-void GLCD::setContrast(char c)
+void GLCD::setContrast(uint8_t c)
 {
 }
 
@@ -1839,43 +1858,43 @@
   x = WIDTH-x-w;
   if(_driverCode==SSD1289_ID)
   {
-      wr_reg(0x44, y);                      /* Horizontal GRAM Start Address      */
-    wr_reg(0x44, y |((y+CHAR_H-1)<<8));   /* Horizontal GRAM End   Address (-1) */
-    wr_reg(0x45, x);                      /* Vertical   GRAM Start Address      */
-    wr_reg(0x46, x+w-1);                  /* Vertical   GRAM End   Address (-1) */
+      _wr_reg(0x44, y);                      /* Horizontal GRAM Start Address      */
+    _wr_reg(0x44, y |((y+CHAR_H-1)<<8));   /* Horizontal GRAM End   Address (-1) */
+    _wr_reg(0x45, x);                      /* Vertical   GRAM Start Address      */
+    _wr_reg(0x46, x+w-1);                  /* Vertical   GRAM End   Address (-1) */
   }
   else
   {
-      wr_reg(0x50, y);                      /* Horizontal GRAM Start Address      */
-      wr_reg(0x51, y+CHAR_H-1);             /* Horizontal GRAM End   Address (-1) */
-      wr_reg(0x52, x);                      /* Vertical   GRAM Start Address      */
-      wr_reg(0x53, x+w-1);                  /* Vertical   GRAM End   Address (-1) */
+      _wr_reg(0x50, y);                      /* Horizontal GRAM Start Address      */
+      _wr_reg(0x51, y+CHAR_H-1);             /* Horizontal GRAM End   Address (-1) */
+      _wr_reg(0x52, x);                      /* Vertical   GRAM Start Address      */
+      _wr_reg(0x53, x+w-1);                  /* Vertical   GRAM End   Address (-1) */
   }
 
   val = (val * w) >> 10;                /* Scale value for 24x12 characters   */
   if(_driverCode==SSD1289_ID)
   {
-      wr_reg(0x4e, y);
-      wr_reg(0x4f, x);
+      _wr_reg(0x4e, y);
+      _wr_reg(0x4f, x);
   }
   else
   {
-      wr_reg(0x20, y);
-      wr_reg(0x21, x);
+      _wr_reg(0x20, y);
+      _wr_reg(0x21, x);
   }
   LCD_CS(0)
-  wr_cmd(0x22);
-  wr_dat_start();
+  _wr_cmd(0x22);
+  _wr_dat_start();
   for (i = 0; i < h; i++) {
     for (j = w-1; j >= 0; j--) {
       if(j >= val) {
-        wr_dat_only(_backColor);
+        _wr_dat_only(_backColor);
       } else {
-        wr_dat_only(_textColor);
+        _wr_dat_only(_textColor);
       }
     }
   }
-  wr_dat_stop();
+  _wr_dat_stop();
 }
 
 
@@ -1891,40 +1910,40 @@
 *   Return:                                                                    *
 *******************************************************************************/
 
-void GLCD::Bitmap (unsigned int x, unsigned int y, unsigned int w, unsigned int h, unsigned char *bitmap) {
+void GLCD::Bitmap (unsigned int x, unsigned int y, unsigned int w, unsigned int h, uint8_t *bitmap) {
   unsigned int    i, j;
-  unsigned short *bitmap_ptr = (unsigned short *)bitmap;
+  uint16_t *bitmap_ptr = (uint16_t *)bitmap;
 
   x = WIDTH-x-w;
   if(_driverCode==SSD1289_ID)
   {
-      wr_reg(0x44, y);                      /* Horizontal GRAM Start Address      */
-    wr_reg(0x44, y |((y+h-1)<<8));        /* Horizontal GRAM End   Address (-1) */
-    wr_reg(0x45, x);                      /* Vertical   GRAM Start Address      */
-    wr_reg(0x46, x+w-1);                  /* Vertical   GRAM End   Address (-1) */
-      wr_reg(0x4e, y);
-      wr_reg(0x4f, x);
+      _wr_reg(0x44, y);                      /* Horizontal GRAM Start Address      */
+    _wr_reg(0x44, y |((y+h-1)<<8));        /* Horizontal GRAM End   Address (-1) */
+    _wr_reg(0x45, x);                      /* Vertical   GRAM Start Address      */
+    _wr_reg(0x46, x+w-1);                  /* Vertical   GRAM End   Address (-1) */
+      _wr_reg(0x4e, y);
+      _wr_reg(0x4f, x);
   }
   else
   {
-      wr_reg(0x50, y);                      /* Horizontal GRAM Start Address      */
-    wr_reg(0x51, y+h-1);                  /* Horizontal GRAM End   Address (-1) */
-    wr_reg(0x52, x);                      /* Vertical   GRAM Start Address      */
-    wr_reg(0x53, x+w-1);                  /* Vertical   GRAM End   Address (-1) */
-      wr_reg(0x20, y);
-      wr_reg(0x21, x);
+      _wr_reg(0x50, y);                      /* Horizontal GRAM Start Address      */
+    _wr_reg(0x51, y+h-1);                  /* Horizontal GRAM End   Address (-1) */
+    _wr_reg(0x52, x);                      /* Vertical   GRAM Start Address      */
+    _wr_reg(0x53, x+w-1);                  /* Vertical   GRAM End   Address (-1) */
+      _wr_reg(0x20, y);
+      _wr_reg(0x21, x);
   }
   LCD_CS(0)
-  wr_cmd(0x22);
-  wr_dat_start();
+  _wr_cmd(0x22);
+  _wr_dat_start();
   for (j = 0; j < h; j++) {
     bitmap_ptr += w-1;
     for (i = 0; i < w; i++) {
-      wr_dat_only(*bitmap_ptr--);
+      _wr_dat_only(*bitmap_ptr--);
     }
     bitmap_ptr += w+1;
   }
-  wr_dat_stop();
+  _wr_dat_stop();
 }
 
 
@@ -1940,49 +1959,221 @@
 *   Return:                                                                    *
 *******************************************************************************/
 
-void GLCD::Bmp (unsigned int x, unsigned int y, unsigned int w, unsigned int h, unsigned char *bmp) {
+void GLCD::Bmp (unsigned int x, unsigned int y, unsigned int w, unsigned int h, uint8_t *bmp) {
   unsigned int    i, j;
-  unsigned short *bitmap_ptr = (unsigned short *)bmp;
+  uint16_t *bitmap_ptr = (uint16_t *)bmp;
 
 //wh  x = WIDTH-x-w;
 
   if(_driverCode==SSD1289_ID)
   {
-//wh      wr_reg(0x44, y);                      /* Horizontal GRAM Start Address      */
-    wr_reg(0x44, y |((y+h-1)<<8));        /* Horizontal GRAM End   Address (-1) */
-    wr_reg(0x45, x);                      /* Vertical   GRAM Start Address      */
-    wr_reg(0x46, x+w-1);                  /* Vertical   GRAM End   Address (-1) */
-      wr_reg(0x4e, y);
-      wr_reg(0x4f, x);
+//wh      _wr_reg(0x44, y);                      /* Horizontal GRAM Start Address      */
+    _wr_reg(0x44, y |((y+h-1)<<8));        /* Horizontal GRAM End   Address (-1) */
+    _wr_reg(0x45, x);                      /* Vertical   GRAM Start Address      */
+    _wr_reg(0x46, x+w-1);                  /* Vertical   GRAM End   Address (-1) */
+      _wr_reg(0x4e, y);
+      _wr_reg(0x4f, x);
   }
   else
   {
-      wr_reg(0x50, y);                      /* Horizontal GRAM Start Address      */
-    wr_reg(0x51, y+h-1);                  /* Horizontal GRAM End   Address (-1) */
-    wr_reg(0x52, x);                      /* Vertical   GRAM Start Address      */
-    wr_reg(0x53, x+w-1);                  /* Vertical   GRAM End   Address (-1) */
-      wr_reg(0x20, y);
-      wr_reg(0x21, x);
+      _wr_reg(0x50, y);                      /* Horizontal GRAM Start Address      */
+    _wr_reg(0x51, y+h-1);                  /* Horizontal GRAM End   Address (-1) */
+    _wr_reg(0x52, x);                      /* Vertical   GRAM Start Address      */
+    _wr_reg(0x53, x+w-1);                  /* Vertical   GRAM End   Address (-1) */
+      _wr_reg(0x20, y);
+      _wr_reg(0x21, x);
   }
   LCD_CS(0)
-  wr_cmd(0x22);
-  wr_dat_start();
+  _wr_cmd(0x22);
+  _wr_dat_start();
 //  bitmap_ptr += (h*w)-1;
 //  for (j = 0; j < h; j++) {
 //    for (i = 0; i < w; i++) {
-//      wr_dat_only(*bitmap_ptr--);
+//      _wr_dat_only(*bitmap_ptr--);
 //    }
 //  }
 
 
   for (j = 0; j < h; j++) {
     for (i = 0; i < w; i++) {
-      wr_dat_only(*bitmap_ptr++);
+      _wr_dat_only(*bitmap_ptr++);
     }
   }
 
 
-  wr_dat_stop();
+  _wr_dat_stop();
+}
+
+
+
+
+
+#if(0)
+
+void LCD_PolyLine(pPoint Points, uint16_t PointCount)
+{
+  int16_t X = 0, Y = 0;
+
+  if(PointCount < 2)
+  {
+    return;
+  }
+
+  while(--PointCount)
+  {
+    X = Points->X;
+    Y = Points->Y;
+    Points++;
+    LCD_DrawUniLine(X, Y, Points->X, Points->Y);
+  }
+}
+
+static void LCD_PolyLineRelativeClosed(pPoint Points, uint16_t PointCount, uint16_t Closed)
+{
+  int16_t X = 0, Y = 0;
+  pPoint First = Points;
+
+  if(PointCount < 2)
+  {
+    return;
+  }  
+  X = Points->X;
+  Y = Points->Y;
+  while(--PointCount)
+  {
+    Points++;
+    LCD_DrawUniLine(X, Y, X + Points->X, Y + Points->Y);
+    X = X + Points->X;
+    Y = Y + Points->Y;
+  }
+  if(Closed)
+  {
+    LCD_DrawUniLine(First->X, First->Y, X, Y);
+  }  
+}
+
+void LCD_ClosedPolyLine(pPoint Points, uint16_t PointCount)
+{
+  LCD_PolyLine(Points, PointCount);
+  LCD_DrawUniLine(Points->X, Points->Y, (Points+PointCount-1)->X, (Points+PointCount-1)->Y);
+}
+
+
+void LCD_PolyLineRelative(pPoint Points, uint16_t PointCount)
+{
+  LCD_PolyLineRelativeClosed(Points, PointCount, 0);
+}
+
+
+void LCD_ClosedPolyLineRelative(pPoint Points, uint16_t PointCount)
+{
+  LCD_PolyLineRelativeClosed(Points, PointCount, 1);
 }
 
+void LCD_FillPolyLine(pPoint Points, uint16_t PointCount)
+{
+  /*  public-domain code by Darel Rex Finley, 2007 */
+  uint16_t  nodes = 0, nodeX[MAX_POLY_CORNERS], pixelX = 0, pixelY = 0, i = 0,
+  j = 0, swap = 0;
+  uint16_t  IMAGE_LEFT = 0, IMAGE_RIGHT = 0, IMAGE_TOP = 0, IMAGE_BOTTOM = 0;
+
+  IMAGE_LEFT = IMAGE_RIGHT = Points->X;
+  IMAGE_TOP= IMAGE_BOTTOM = Points->Y;
+
+  for(i = 1; i < PointCount; i++)
+  {
+    pixelX = POLY_X(i);
+    if(pixelX < IMAGE_LEFT)
+    {
+      IMAGE_LEFT = pixelX;
+    }
+    if(pixelX > IMAGE_RIGHT)
+    {
+      IMAGE_RIGHT = pixelX;
+    }
+    
+    pixelY = POLY_Y(i);
+    if(pixelY < IMAGE_TOP)
+    { 
+      IMAGE_TOP = pixelY;
+    }
+    if(pixelY > IMAGE_BOTTOM)
+    {
+      IMAGE_BOTTOM = pixelY;
+    }
+  }
+  
+  LCD_SetTextColor(BackColor);  
+
+  /*  Loop through the rows of the image. */
+  for (pixelY = IMAGE_TOP; pixelY < IMAGE_BOTTOM; pixelY++) 
+  {  
+    /* Build a list of nodes. */
+    nodes = 0; j = PointCount-1;
+
+    for (i = 0; i < PointCount; i++) 
+    {
+      if (((POLY_Y(i)<(double) pixelY) && (POLY_Y(j)>=(double) pixelY)) || \
+          ((POLY_Y(j)<(double) pixelY) && (POLY_Y(i)>=(double) pixelY)))
+      {
+        nodeX[nodes++]=(int) (POLY_X(i)+((pixelY-POLY_Y(i))*(POLY_X(j)-POLY_X(i)))/(POLY_Y(j)-POLY_Y(i))); 
+      }
+      j = i; 
+    }
+  
+    /* Sort the nodes, via a simple "Bubble" sort. */
+    i = 0;
+    while (i < nodes-1) 
+    {
+      if (nodeX[i]>nodeX[i+1]) 
+      {
+        swap = nodeX[i]; 
+        nodeX[i] = nodeX[i+1]; 
+        nodeX[i+1] = swap; 
+        if(i)
+        {
+          i--; 
+        }
+      }
+      else 
+      {
+        i++;
+      }
+    }
+  
+    /*  Fill the pixels between node pairs. */
+    for (i = 0; i < nodes; i+=2) 
+    {
+      if(nodeX[i] >= IMAGE_RIGHT) 
+      {
+        break;
+      }
+      if(nodeX[i+1] > IMAGE_LEFT) 
+      {
+        if (nodeX[i] < IMAGE_LEFT)
+        {
+          nodeX[i]=IMAGE_LEFT;
+        }
+        if(nodeX[i+1] > IMAGE_RIGHT)
+        {
+          nodeX[i+1] = IMAGE_RIGHT;
+        }
+        LCD_SetTextColor(BackColor);
+        LCD_DrawLine(pixelY, nodeX[i+1], nodeX[i+1] - nodeX[i], LCD_DIR_HORIZONTAL);
+        LCD_SetTextColor(TextColor);
+        PutPixel(pixelY, nodeX[i+1]);
+        PutPixel(pixelY, nodeX[i]);
+        /* for (j=nodeX[i]; j<nodeX[i+1]; j++) PutPixel(j,pixelY); */
+      }
+    }
+  } 
+
+  /* draw the edges */
+  LCD_SetTextColor(TextColor);
+}
+
+
+
+
+#endif
 /******************************************************************************/