Improve lcd handling for ETC

Author: mubes

Inc/orblcd_protocol.h

@@ -14,19 +14,24 @@
 #define ORBLCD_CMD_CLEAR        (3)
 #define ORBLCD_CMD_GOTOXY       (4)
 
+#define LCD_BE                  (0)
+#define LCD_LE                  (1)
+
 #define ORBLCD_ENCODE_X(x) ((x&0xfff)<<0)
 #define ORBLCD_ENCODE_Y(x) ((x&0xfff)<<12)
 #define ORBLCD_ENCODE_D(x) ((x&0x03)<<24)
 #define ORBLCD_ENCODE_C(x) ((x&0x3f)<<26)
+#define ORBLCD_ENCODE_L(x) ((x&0x01)<<31)
 #define ORBLCD_DECODE_X(x) ((x>>0)&0xfff)
 #define ORBLCD_DECODE_Y(x) ((x>>12)&0xfff)
 #define ORBLCD_DECODE_D(x) ((x>>24)&0x03)
-#define ORBLCD_DECODE_C(x) ((x>>26)&0x3f)
+#define ORBLCD_DECODE_C(x) ((x>>26)&0x1f)
+#define ORBLCD_DECODE_L(x) ((x>>31)&0x01)
 
 #define ORBLCD_GET_DEPTH(x)        (((int[]){1,8,16,24})[ORBLCD_DECODE_D(x)])
 #define ORBLCD_PIXELS_PER_WORD(x)  (((int[]){32,4,2,1})[ORBLCD_DECODE_D(x)])
 
-#define ORBLCD_OPEN_SCREEN(x,y,d) (ORBLCD_ENCODE_C(ORBLCD_CMD_INIT_LCD)|ORBLCD_ENCODE_D(d)|ORBLCD_ENCODE_X(x)|ORBLCD_ENCODE_Y(y))
+#define ORBLCD_OPEN_SCREEN(x,y,d,l) (ORBLCD_ENCODE_L(l)|ORBLCD_ENCODE_C(ORBLCD_CMD_INIT_LCD)|ORBLCD_ENCODE_D(d)|ORBLCD_ENCODE_X(x)|ORBLCD_ENCODE_Y(y))
 #define ORBLCD_CLOSE_SCREEN       (ORBLCD_ENCODE_C(ORBLCD_CMD_CLOSE_SCREEN))
 #define ORBLCD_CLEAR              (ORBLCD_ENCODE_C(ORBLCD_CMD_CLEAR))
 

Src/orblcd.c

@@ -127,7 +127,14 @@ static void _paintPixels( struct swMsg *m, struct RunTime *r )
         switch ( ORBLCD_DECODE_D( r->app->modeDescriptor ) )
         {
             case ORBLCD_DEPTH_1:
-                y = ( d & ( 1 << ( b % 8 ) ) ) ? r->app->sbcolour : 0;
+                if ( ORBLCD_DECODE_L( r->app->modeDescriptor ) )
+                {
+                    y = ( d & ( 128 >> ( b % 8 ) ) ) ? r->app->sbcolour : 0;
+                }
+                else
+                {
+                    y = ( d & ( 1 << ( b % 8 ) ) ) ? r->app->sbcolour : 0;
+                }
 
                 if ( !( b % 8 ) )
                 {