From d18c319c89d4b8684af5b731cf0057f3ea049c46 Mon Sep 17 00:00:00 2001
From: XANTRONIX Development <dev@xantronix.com>
Date: Sun, 15 May 2016 02:59:26 -0500
Subject: [PATCH] Fix dithering stupidity in cammy_image_dither()

---
 src/photo.c | 12 +++++++++---
 1 file changed, 9 insertions(+), 3 deletions(-)

diff --git a/src/photo.c b/src/photo.c
index 0ffa566..3128e22 100644
--- a/src/photo.c
+++ b/src/photo.c
@@ -140,6 +140,10 @@ void cammy_photo_dither(uint8_t *dest,
                             int  width,
                             int  height,
                             int  stride) {
+    static uint8_t values[4] = {
+        0, 86, 171, 255
+    };
+
     size_t x, y;
 
     for (y=0; y<height; y++) {
@@ -164,9 +168,11 @@ void cammy_photo_dither(uint8_t *dest,
                 value = from ^ 0x03;
             }
 
-            dest[stride*CAMMY_PHOTO_WIDTH*y+stride*x]   = value;
-            dest[stride*CAMMY_PHOTO_WIDTH*y+stride*x+1] = value;
-            dest[stride*CAMMY_PHOTO_WIDTH*y+stride*x+2] = value;
+            value ^= 3;
+
+            dest[stride*width*y+stride*x]   = values[value];
+            dest[stride*width*y+stride*x+1] = values[value];
+            dest[stride*width*y+stride*x+2] = values[value];
         }
     }
 }