diff --git a/bsp/includes/BEAGLESYNTH/bsp.h b/bsp/includes/BEAGLESYNTH/bsp.h
--- a/bsp/includes/BEAGLESYNTH/bsp.h
+++ b/bsp/includes/BEAGLESYNTH/bsp.h
@@ -64,7 +64,7 @@ extern void bsp_uart_init();
 extern void bsp_iic_init();
 extern void bsp_spi_init();
 extern void bsp_SD_init();
-extern void bsp_FSMC_init();
+extern int bsp_FSMC_init();
 
 /*  VS1053  */
 extern void clearXCS();
@@ -77,6 +77,12 @@ char bspsdcardpresent();
 void bspsdcardselect(char YESNO);
 char bspsdcardwriteprotected();
 
+
+void bsp_lcd0_write_reg(uint32_t reg,uint32_t data);
+uint32_t bsp_lcd0_read_reg(uint32_t reg);
+void bsp_lcd0_writeGRAM(void *buffer, uint32_t count);
+void bsp_lcd0_readGRAM(void *buffer, uint32_t count);
+
 #endif
 
 
diff --git a/bsp/src/BEAGLESYNTH/bsp.c b/bsp/src/BEAGLESYNTH/bsp.c
--- a/bsp/src/BEAGLESYNTH/bsp.c
+++ b/bsp/src/BEAGLESYNTH/bsp.c
@@ -33,8 +33,23 @@ uint32_t INTOSC =16000000;
 uint32_t RTCOSC =32768;
 uint32_t currentCpuFreq=0;
 extern streamdevice* __opnfiles__[__MAX_OPENED_FILES__];
-LCD_t lcd0;
-LCD_IF_t lcdIF0;
+
+LCD_IF_t lcdIF0={
+    .init = &bsp_FSMC_init,
+    .writereg = &bsp_lcd0_write_reg,
+    .readreg = &bsp_lcd0_read_reg,
+    .writeGRAM = &bsp_lcd0_writeGRAM,
+    .readGRAM = &bsp_lcd0_readGRAM
+};
+
+LCD_t lcd0={
+    .interface = &lcdIF0,
+    .init = &ili9328init,
+    .paint = &ili9328paint,
+    .refreshenable = &ili9328refreshenable,
+    .width= 240,
+    .height = 320
+};
 
 volatile int16_t* lcd0_CMD=(volatile int16_t*)  0x60000000;
 volatile int16_t* lcd0_DATA=(volatile int16_t*)(0x61FFFFF0);
@@ -103,12 +118,9 @@ void bsp_uart_init()
     }
 }
 
-void bsp_lcd0_write_reg(uint32_t reg,uint32_t data);
-uint32_t bsp_lcd0_read_reg(uint32_t reg);
-void bsp_lcd0_writeGRAM(void *buffer, uint32_t count);
-void bsp_lcd0_readGRAM(void *buffer, uint32_t count);
+
 
-void bsp_FSMC_init()
+int bsp_FSMC_init()
 {
     #define GPIOGETPORT(gpio)   ((GPIO_TypeDef*)(((((uint32_t)gpio) & (uint32_t)0x0000FF00)*(uint32_t)4) + (uint32_t)GPIOA))
     #define GPIOPORTNUM(gpio)   (((uint32_t)(gpio) & (uint32_t)0x0000FF00)>>(uint32_t)8)
@@ -138,10 +150,10 @@ void bsp_FSMC_init()
   /*----------------------- SRAM Bank 3 ----------------------------------------*/
     /* FSMC_Bank1_NORSRAM4 configuration */
     //p.FSMC_AddressSetupTime = 5;
-    p.FSMC_AddressSetupTime = 1;
+    p.FSMC_AddressSetupTime = 2;
     p.FSMC_AddressHoldTime = 0;
     //p.FSMC_DataSetupTime = 9;
-    p.FSMC_DataSetupTime = 3;
+    p.FSMC_DataSetupTime = 4;
     p.FSMC_BusTurnAroundDuration = 0;
     p.FSMC_CLKDivision = 0;
     p.FSMC_DataLatency = 0;
@@ -175,15 +187,9 @@ void bsp_FSMC_init()
 
     /* Enable FSMC NOR/SRAM Bank1 */
     FSMC_NORSRAMCmd(FSMC_Bank1_NORSRAM1, ENABLE);
-    lcdIF0.writereg=&bsp_lcd0_write_reg;    
-    lcdIF0.readGRAM=&bsp_lcd0_readGRAM;
-    lcdIF0.readreg=&bsp_lcd0_read_reg;
-    lcdIF0.writeGRAM=&bsp_lcd0_writeGRAM;
-    lcd0.interface=&lcdIF0;
-    lcd0.init=&ili9328init;
-    lcd0.paint=&ili9328paint;
     gpioset(LCD_RESET);
     lcd0.init(&lcd0);
+    return 1;
 }
 
 void bsp_spi_init()
@@ -233,6 +239,7 @@ void bspsdcardselect(char YESNO)
 
 void bsp_lcd0_write_reg(uint32_t reg,uint32_t data)
 {
+    printf("Write %X @ %d\n\r",data,reg);
     *lcd0_CMD=(uint16_t)reg;
     *lcd0_DATA=(uint16_t)data;
 }
@@ -245,12 +252,14 @@ uint32_t bsp_lcd0_read_reg(uint32_t reg)
 
 void bsp_lcd0_writeGRAM(void* buffer,uint32_t count)
 {
+    printf("Write to GRAM %d pixels from 0x%X\t\n\r",count,(int)buffer);
     *lcd0_CMD=(uint16_t)ILI9328_REGISTER_WRITEDATATOGRAM;
     uint16_t* castedBuff=(uint16_t*)buffer;
-    for(uint32_t i=0;i<count;i++)
+    for(int i=0;i<(int)count;i++)
     {
          *lcd0_DATA=castedBuff[i];
     }
+    printf("[Done]\n\r");
 }
 
 void bsp_lcd0_readGRAM(void* buffer,uint32_t count)
@@ -258,7 +267,7 @@ void bsp_lcd0_readGRAM(void* buffer,uint
     *lcd0_CMD=(uint16_t)ILI9328_REGISTER_WRITEDATATOGRAM;
     uint16_t* castedBuff=(uint16_t*)buffer;
     castedBuff[0]=*lcd0_DATA;
-    for(uint32_t i=0;i<count;i++)
+    for(int i=0;i<(int)count;i++)
     {
          castedBuff[i]=*lcd0_DATA;
     }
diff --git a/examples/BeagleSynthHello/main.c b/examples/BeagleSynthHello/main.c
--- a/examples/BeagleSynthHello/main.c
+++ b/examples/BeagleSynthHello/main.c
@@ -22,39 +22,34 @@ int main()
     //ina226open(&ina15VSens,i2c2,INA226_MODE_SHUNT_VOLTAGE_CONTINUOUS|INA226_AVERAGES_16|INA226_BUS_CONV_8244us|INA226_SHUNT_CONV_8244us,1,0,15,1000000);
     *regtest=(int16_t)0;
     printf("LCD ID=%x\n\r",0xFFFF&(*regtest2));
-
+    //lcd0.refreshenable(&lcd0,1);
     while(1)
     {
-       /* *regtest=(int16_t)ILI9328_REGISTER_ENTRYMODE;
-        *regtest2=(int16_t)0x1008;*/
-        ili9328setFrame(&lcd0,0,0,240,320);
+        //ili9328setFrame(&lcd0,0,0,240,320);
+        //ili9328setGRAMaddress(&lcd0,0,0);
+        *regtest=(int16_t)0x20;
+        *regtest2=(int16_t)0x0;
+        *regtest=(int16_t)0x21;
+        *regtest2=(int16_t)0x0;
         *regtest=(int16_t)0x22;
-        for(volatile int i=0;i<(320*240);i++)
+        for(int i=0;i<(320*240);i++)
         {
             *regtest2=(int16_t)0x001F;
-            //for(volatile int l=0;l<(1024);l++);
-
         }
-       /* *regtest=(int16_t)ILI9328_REGISTER_ENTRYMODE;
-        *regtest2=(int16_t)0x1018;*/
         for(volatile int i=0;i<(320*240*100);i++);
-       /* *regtest=(int16_t)ILI9328_REGISTER_ENTRYMODE;
-        *regtest2=(int16_t)0x1008;*/
-        //ili9328setGRAMaddress(&lcd0,60,80);
-        uint16_t test[80*80];
-        ili9328setFrame(&lcd0,10,10,100,100);
-        *regtest=(int16_t)0x22;
-        for(volatile int i=0;i<(100*100);i++)
-        {
-            *regtest2=(int16_t)(0xF800);
-            //test[i]=(int16_t)0xF800;
-            //for(volatile int l=0;l<(1024);l++);
+        //uint16_t test[100];
+        //ili9328setFrame(&lcd0,10,10,10,10);
+        //*regtest=(int16_t)0x22;
+        //for(int i=0;i<(10*10);i++)
+        //{
+        //   *regtest2=(int16_t)(0xF800);
+        //test[i]=(int16_t)0xF800;
+        //for(volatile int l=0;l<(1024);l++);
 
-        }
+        //}
+        //bsp_lcd0_writeGRAM(test,10*10);
         //lcd0.paint(&lcd0,test,100,100,80,80);
-        /**regtest=(int16_t)ILI9328_REGISTER_ENTRYMODE;
-        *regtest2=(int16_t)0x1018;*/
-        for(volatile int i=0;i<(320*240*100);i++);
+        //for(volatile int i=0;i<(320*240*100);i++);
     }
 
     if(-1==ina226open(&ina33VSens,i2c2,INA226_MODE_SHUNT_VOLTAGE_CONTINUOUS|INA226_AVERAGES_16|INA226_BUS_CONV_8244us|INA226_SHUNT_CONV_8244us,0,1,15,1000000))
diff --git a/lib/includes/GRAPHIC/CONTROLERS/genericLCD_Controler.h b/lib/includes/GRAPHIC/CONTROLERS/genericLCD_Controler.h
--- a/lib/includes/GRAPHIC/CONTROLERS/genericLCD_Controler.h
+++ b/lib/includes/GRAPHIC/CONTROLERS/genericLCD_Controler.h
@@ -40,6 +40,7 @@ typedef struct LCD_t
     LCD_IF_t* interface;
     int (*init)(struct LCD_t* LCD);
     void (*paint)(struct LCD_t* LCD,void* buffer,uint16_t Xpos,uint16_t Ypos,uint16_t Width,uint16_t Height);
+    void (*refreshenable)(struct LCD_t* LCD,int enable);
     uint16_t width;
     uint16_t height;
 }LCD_t;
diff --git a/lib/includes/GRAPHIC/CONTROLERS/ili9328.h b/lib/includes/GRAPHIC/CONTROLERS/ili9328.h
--- a/lib/includes/GRAPHIC/CONTROLERS/ili9328.h
+++ b/lib/includes/GRAPHIC/CONTROLERS/ili9328.h
@@ -27,9 +27,10 @@
 #include <stdint.h>
 
 extern int ili9328init(struct LCD_t* LCD);
-extern void ili9328setFrame(LCD_t* LCD,uint16_t HaddressStart,uint16_t VaddressStart,uint16_t HaddressStop,uint16_t VaddressStop);
+extern void ili9328setFrame(LCD_t* LCD,uint16_t X,uint16_t Y,uint16_t W,uint16_t H);
 extern void ili9328setGRAMaddress(LCD_t* LCD,uint16_t Haddress,uint16_t Vaddress);
 extern void ili9328paint(LCD_t* LCD,void* buffer,uint16_t Xpos,uint16_t Ypos,uint16_t Width,uint16_t Height);
+extern void ili9328refreshenable(struct LCD_t* LCD,int enable);
 
 #define	ILI9328_REGISTER_DRIVERCODEREAD	((uint32_t)	0x0000	)
 #define	ILI9328_REGISTER_DRIVEROUTPUTCONTROL1	((uint32_t)	0x0001	)
diff --git a/lib/src/common/GRAPHIC/CONTROLERS/ILI9328/ili9328.c b/lib/src/common/GRAPHIC/CONTROLERS/ILI9328/ili9328.c
--- a/lib/src/common/GRAPHIC/CONTROLERS/ILI9328/ili9328.c
+++ b/lib/src/common/GRAPHIC/CONTROLERS/ILI9328/ili9328.c
@@ -31,12 +31,29 @@ void ili9328setGRAMaddress(LCD_t* LCD,ui
     LCD->interface->writereg(ILI9328_REGISTER_VERTICALGRAMADDRESSSET,Vaddress);
 }
 
-void ili9328setFrame(LCD_t* LCD,uint16_t HaddressStart,uint16_t VaddressStart,uint16_t HaddressStop,uint16_t VaddressStop)
+void ili9328refreshenable(struct LCD_t* LCD,int enable)
 {
-    LCD->interface->writereg(ILI9328_REGISTER_HORIZONTALADDRESSSTARTPOSITION,HaddressStart);
-    LCD->interface->writereg(ILI9328_REGISTER_VERTICALADDRESSSTARTPOSITION,VaddressStart);
-    LCD->interface->writereg(ILI9328_REGISTER_HORIZONTALADDRESSENDPOSITION,HaddressStop);
-    LCD->interface->writereg(ILI9328_REGISTER_VERTICALADDRESSENDPOSITION,VaddressStop);
+    if(enable)
+    {
+        //LCD->interface->writereg(ILI9328_REGISTER_ENTRYMODE,0x1018);
+    }
+    else
+    {
+        //LCD->interface->writereg(ILI9328_REGISTER_ENTRYMODE,0x1008);
+
+    }
+}
+
+void ili9328setFrame(LCD_t* LCD,uint16_t X,uint16_t Y,uint16_t W,uint16_t H)
+{
+    printf("setFrame X=%d Y=%d W=%d H=%d\n\r",(int)X,(int)Y,(int)W,(int)H);
+    LCD->interface->writereg(ILI9328_REGISTER_HORIZONTALGRAMADDRESSSET,X);
+    LCD->interface->writereg(ILI9328_REGISTER_VERTICALGRAMADDRESSSET,Y);
+    LCD->interface->writereg(ILI9328_REGISTER_HORIZONTALADDRESSSTARTPOSITION,X);
+    LCD->interface->writereg(ILI9328_REGISTER_HORIZONTALADDRESSSTARTPOSITION,X);
+    LCD->interface->writereg(ILI9328_REGISTER_HORIZONTALADDRESSENDPOSITION,W+X);
+    LCD->interface->writereg(ILI9328_REGISTER_VERTICALADDRESSSTARTPOSITION,Y);
+    LCD->interface->writereg(ILI9328_REGISTER_VERTICALADDRESSENDPOSITION,Y+H);
 }
 
 void ili9328paint(LCD_t* LCD,void* buffer,uint16_t Xpos,uint16_t Ypos,uint16_t Width,uint16_t Height)
@@ -44,8 +61,8 @@ void ili9328paint(LCD_t* LCD,void* buffe
     if((LCD!=NULL) && (LCD->interface!=NULL) && (LCD->interface->writeGRAM!=NULL) &&  (LCD->width<(Xpos+Width)) && (LCD->height<(Ypos+Height)))
     {
         printf("paint\n\r");
-        ili9328setFrame(LCD,Xpos,Ypos,Xpos+Width,Ypos+Height);
-        ili9328setGRAMaddress(LCD,Xpos,Ypos);
+        ili9328setFrame(LCD,Xpos,Ypos,Width,Height);
+        //ili9328setGRAMaddress(LCD,Xpos,Ypos);
         LCD->interface->writeGRAM(buffer,Width*Height);
     }
 }
@@ -93,7 +110,7 @@ int ili9328init(struct LCD_t* LCD)
         // Display On
         LCD->interface->writereg(ILI9328_REGISTER_DISPLAYCONTROL1, 0x0133);     // Display Control (R07h)
         _delay_(500000);
-        LCD->interface->writereg(ILI9328_REGISTER_ENTRYMODE, 0x1030);
+        LCD->interface->writereg(ILI9328_REGISTER_ENTRYMODE, 0x1018);
         LCD->interface->writereg(ILI9328_REGISTER_DRIVEROUTPUTCONTROL1, 0x0100);
         //ili9328WriteCmd(ILI9328_REGISTER_WRITEDATATOGRAM);
     }