rectPoints are now Point2D

bbiwarg/Graphics/Output2D.cs

@@ -105,11 +105,9 @@ namespace bbiwarg.Graphics
                     {
                         int px = Math.Min(depthImage.getWidth() - 1, Math.Max(0, x + i));
                         int py = Math.Min(depthImage.getHeight() - 1, Math.Max(0, y + j));
-                        index = 3 * (py * depthImage.getWidth() + px);
-                        textureData[index + 0] = 0;
-                        textureData[index + 1] = 0;
-                        textureData[index + 2] = Int16.MaxValue;
-            
+                        Vector positon = new DenseVector(new float[] { px, py });
+                        Point2D point = new Point2D(positon, Color.Blue);
+                        point.draw(textureData, depthImage.getWidth());
                     }
                 }
             }