Changed over to new colorizer.

MariCam/Program.cs

@@ -80,6 +80,16 @@ namespace MariCam
 
             arducamCameraReleaseFrame(camera, tempBuffer);
 
+            var gradients = GenerateGradients(new List<Color>()
+            {
+                Color.FromArgb(255, 64, 64, 128), //Violet
+                Color.FromArgb(255, 0, 0, 255), //Blue
+                Color.FromArgb(255, 0, 255, 255), //Cyan
+                Color.FromArgb(255, 255, 255, 0), //Yellow
+                Color.FromArgb(255, 255, 165, 0), //Orange
+                Color.FromArgb(255, 255, 0, 0) //Red
+            }, 255);
+
             var form = new Form();
 
             form.Text = "MariCam";
@@ -121,9 +131,6 @@ namespace MariCam
                     }
                 }
 
-                float minNew = -1.0f;
-                float maxNew = 1.0f;
-
                 var bufferData = buffer.LockBits(new Rectangle(0, 0, buffer.Width, buffer.Height), ImageLockMode.ReadWrite, buffer.PixelFormat);
 
                 var bufferPixels = (uint*)bufferData.Scan0;
@@ -132,14 +139,12 @@ namespace MariCam
                 {
                     for (int x = 0; x < format.Width; x++)
                     {
+                        var depth = *(depthData + (y * format.Width) + x);
+
                         //maxNew − minNew / maxOld − minOld * (v − minOld) + minNew
-                        var intensity = ((float)(maxNew - minNew) / (float)(max - min) * ((*(depthData + (y * format.Width) + x)) - min) + minNew);
+                        var color = gradients[(int)(((float)((gradients.Count - 1) - 0) / (float)(max - min) * (depth - min)) + 0)];
 
-                        byte r = (intensity < 0.0) ? (byte)0 : (intensity >= 0.5) ? (byte)255 : (byte)(intensity / 0.5 * 255);
+                        *(bufferPixels + ((y * format.Width) + x)) = ((uint)255 << 24) | ((uint)(color.R) << 16) | ((uint)(color.G) << 8) | (byte)(color.B);
-                        byte g = (intensity < -0.5) ? (byte)((intensity + 1) / 0.5 * 255) : (intensity > 0.5) ? (byte)(255 - ((intensity - 0.5) / 0.5 * 255)) : (byte)255;
-                        byte b = (intensity > 0.0) ? (byte)0 : (intensity <= -0.5) ? (byte)255 : (byte)(intensity * -1.0 / 0.5 * 255);
-
-                        *(bufferPixels + ((y * format.Width) + x)) = ((uint)255 << 24) | ((uint)(r) << 16) | ((uint)(g) << 8) | (byte)(b);
                     }
                 }
 
@@ -156,5 +161,29 @@ namespace MariCam
 
             Application.DoEvents();
         }
+
+        public static List<Color> GenerateGradients(List<Color> colors, int steps)
+        {
+            var gradients = new List<Color>();
+
+            for (int i = 0; i < colors.Count - 1; i++)
+            {
+                var from = colors[i];
+
+                var to = colors[i + 1];
+
+                for (int s = 0; s < steps; s++)
+                {
+                    gradients.Add(Color.FromArgb(
+                        255,
+                        (byte)(from.R + (s / (float)steps) * (to.R - from.R)),
+                        (byte)(from.G + (s / (float)steps) * (to.G - from.G)),
+                        (byte)(from.B + (s / (float)steps) * (to.B - from.B))
+                    ));
+                }
+            }
+
+            return gradients;
+        }
     }
 }