diff --git a/drivers/s6d1121_lld.c b/drivers/s6d1121_lld.c
index aa13169e..dfadc19d 100644
--- a/drivers/s6d1121_lld.c
+++ b/drivers/s6d1121_lld.c
@@ -96,13 +96,9 @@ void lcdWriteData(uint16_t lcdData) {
 
 void lcdWriteReg(uint16_t lcdReg, uint16_t lcdRegValue) {
 	LCD_CS_LOW;
-	LCD_RS_LOW;
 
-	lld_lcdwrite(lcdReg);
-
-	LCD_RS_HIGH;
-
-	lld_lcdwrite(lcdRegValue);
+	lcdWriteIndex(lcdReg);
+	lcdWriteData(lcdRegValue);
 
 	LCD_CS_HIGH;
 }
@@ -215,26 +211,22 @@ void lld_lcdSetOrientation(uint8_t newOrientation) {
 
     switch(orientation) {
         case portrait:
-            lcdWriteReg(0x0001, 0x2B3F);
-            lcdWriteReg(0x0011, 0x6070);
+            lcdWriteReg(0x03, 0x03);
             lcd_height = SCREEN_HEIGHT;
             lcd_width = SCREEN_WIDTH;
             break;
         case landscape:
-            lcdWriteReg(0x0001, 0x293F);
-            lcdWriteReg(0x0011, 0x6078);
+        	// Not implemented yet
             lcd_height = SCREEN_WIDTH;
             lcd_width = SCREEN_HEIGHT;
             break;
         case portraitInv:
-            lcdWriteReg(0x0001, 0x693F);
-            lcdWriteReg(0x0011, 0x6040);
+        	// Not implemented yet
             lcd_height = SCREEN_HEIGHT;
             lcd_width = SCREEN_WIDTH;
             break;
         case landscapeInv:
-            lcdWriteReg(0x0001, 0x6B3F);
-            lcdWriteReg(0x0011, 0x6048);
+        	// Not implemented yet
             lcd_height = SCREEN_WIDTH;
             lcd_width = SCREEN_HEIGHT;
             break;
diff --git a/glcd.c b/glcd.c
index 2aca18f9..8c86c8cf 100644
--- a/glcd.c
+++ b/glcd.c
@@ -5,7 +5,7 @@
 
 uint16_t lcd_width, lcd_height;
 uint16_t bgcolor=White, fgcolor=Black;
-uint16_t cx, cy;
+uint16_t cx=0, cy=0;
 static uint8_t tpText=0;
 const uint8_t* font;
 
@@ -151,7 +151,7 @@ void lcdDrawChar(char c) {
 	cx += fontWidth;
 	if(sps != 0) {
 		if(!tpText)
-			lcdFillArea(cx, cy, sps, fontHeight, fgcolor);
+			lcdFillArea(cx, cy, cx+sps, cy+fontHeight, bgcolor);
 		cx += sps;
 	}
 }