[display] Add DISPLAY_FORMAT_RGB_x111

target/dartuinoP0/display/LS013B7DH06.c

 /*
  * Copyright (c) 2015 Gurjant Kalsi <me@gurjantkalsi.com>
  *
  * Permission is hereby granted, free of charge, to any person obtaining
  * a copy of this software and associated documentation files
  * (the "Software"), to deal in the Software without restriction,
  * including without limitation the rights to use, copy, modify, merge,
  * publish, distribute, sublicense, and/or sell copies of the Software,
  * and to permit persons to whom the Software is furnished to do so,
  * subject to the following conditions:
@@ skipping 15 matching lines @@
 #include <string.h>
 
 #define SET_BIT(BUF, BITNUM) ((BUF)[(BITNUM) >> 3] |= (0xff & (0x1 << ((BITNUM) & 0x07))))
 
 uint8_t lcd_get_line(uint8_t *framebuffer, uint8_t idx, uint8_t *result)
 {
     framebuffer += FB_STRIDE * idx;
 
     memset(result, 0, MLCD_BYTES_LINE);
 
+#if FB_FORMAT == DISPLAY_FORMAT_RGB_332
     for (int i = 0; i < MLCD_WIDTH; ++i) {
         uint8_t inpix = framebuffer[i];
 
         int j = i * 3;
 
         if (inpix & 0x80) {
             SET_BIT(result, j);
         }
         if (inpix & 0x10) {
             SET_BIT(result, j + 1);
         }
         if (inpix & 0x02) {
             SET_BIT(result, j + 2);
         }
+    }
+#elif FB_FORMAT == DISPLAY_FORMAT_RGB_x111
+    for (int i = 0; i < FB_STRIDE; ++i) {
+        uint8_t val = framebuffer[i];
+        uint8_t inpix;
 
+        int j = i * 6;
+
+        inpix = val & 0xf;
+        if (inpix & 0x4) {
+            SET_BIT(result, j);
+        }
+        if (inpix & 0x2) {
+            SET_BIT(result, j + 1);
+        }
+        if (inpix & 0x1) {
+            SET_BIT(result, j + 2);
+        }
+
+        inpix = val >> 4;
+        if (inpix & 0x4) {
+            SET_BIT(result, j + 3);
+        }
+        if (inpix & 0x2) {
+            SET_BIT(result, j + 4);
+        }
+        if (inpix & 0x1) {
+            SET_BIT(result, j + 5);
+        }
     }
+#else
+    #error Unhandled FB_FORMAT
+#endif
+
     return MLCD_BYTES_LINE;
-}
+}