From f9cb3d0992d6a533244dd6217cb86725342b1a94 Mon Sep 17 00:00:00 2001
From: bsx <bsx+ccc@0xcafec0.de>
Date: Sun, 22 May 2011 17:48:02 +0200
Subject: [PATCH] added lcdInvert

added possibility to output the display buffer inverted
---
 lcd/display.c | 12 +++++++++++-
 lcd/display.h |  1 +
 modules/bsx.c | 12 +++++++++---
 3 files changed, 21 insertions(+), 4 deletions(-)

diff --git a/lcd/display.c b/lcd/display.c
index 75b2a36..0328dc5 100644
--- a/lcd/display.c
+++ b/lcd/display.c
@@ -30,6 +30,7 @@ void delayms(uint32_t ms)
 /**************************************************************************/
 
 uint8_t lcdBuffer[RESX*RESY_B];
+int inverted = 0;
 
 /*
 //TODO FIXME why doenst that work ?
@@ -160,7 +161,16 @@ void lcdDisplay(uint32_t shift)
     uint16_t i,page;
     for(page=0; page<RESY_B;page++) {
         for(i=0; i<RESX; i++) {
-            lcdWrite(1,lcdBuffer[page*RESX+((i+shift)%RESX)]);
+            if (inverted) {
+                lcdWrite(1,~lcdBuffer[page*RESX+((i+shift)%RESX)]);
+            } else {
+                lcdWrite(1,lcdBuffer[page*RESX+((i+shift)%RESX)]);
+            }
         }
     }
 }
+
+void lcdInvert(void) {
+    inverted = ~inverted;
+}
+
diff --git a/lcd/display.h b/lcd/display.h
index a76c733..9d98e15 100644
--- a/lcd/display.h
+++ b/lcd/display.h
@@ -22,5 +22,6 @@ void lcdRead(uint8_t data);
 void lcdInit(void);
 void lcdFill(char f);
 void lcdDisplay(uint32_t shift);
+void lcdInvert(void);
 
 #endif
diff --git a/modules/bsx.c b/modules/bsx.c
index afaf097..bcd4488 100644
--- a/modules/bsx.c
+++ b/modules/bsx.c
@@ -32,20 +32,25 @@ void module_bsx(void) {
             brightness++;
             if (brightness > 100) brightness = 100;
             backlightSetBrightness(brightness);
-        };
+        }
 
         if(gpioGetValue(RB_BTN0)==0){
             brightness--;
             if (brightness > 100) brightness = 0;
             backlightSetBrightness(brightness);
-        };
+        }
+
+        if (gpioGetValue(RB_BTN3) == 0) {
+            while(gpioGetValue(RB_BTN3)==0);
+            lcdInvert();
+        }
 
         if (gpioGetValue(RB_BTN4)==0) {
             while(gpioGetValue(RB_BTN4)==0);
             DoString(0,8,"Enter ISP!");
             lcdDisplay(0);
             ReinvokeISP();
-        };
+        }
 
         dx = DoString(0, yctr, "Bright:");
         dx = DoInt(dx, yctr, brightness);
@@ -72,3 +77,4 @@ void module_bsx(void) {
 
     return;
 }
+