From 7ea248577178f45033802ba5cc2867f8a66d69f8 Mon Sep 17 00:00:00 2001
From: Mike Turvey <mturvey6@gmail.com>
Date: Sun, 5 Feb 2017 23:01:34 -0700
Subject: Adding lighthousefind_tori

---
 tools/lighthousefind_tori/visualization.h | 48 +++++++++++++++++++++++++++++++
 1 file changed, 48 insertions(+)
 create mode 100644 tools/lighthousefind_tori/visualization.h

(limited to 'tools/lighthousefind_tori/visualization.h')

diff --git a/tools/lighthousefind_tori/visualization.h b/tools/lighthousefind_tori/visualization.h
new file mode 100644
index 0000000..e7f9475
--- /dev/null
+++ b/tools/lighthousefind_tori/visualization.h
@@ -0,0 +1,48 @@
+
+#ifndef __VISUALIZATION_H
+#define __VISUALIZATION_H
+
+#include <stdio.h>
+#include "tori_includes.h"
+#include "find_tori_math.h"
+
+extern int pointsWritten;
+
+void writePoint(FILE *file, double x, double y, double z, unsigned int rgb);
+
+void updateHeader(FILE * file);
+
+void writeAxes(FILE * file);
+
+void drawLineBetweenPoints(FILE *file, Point a, Point b, unsigned int color);
+
+void writePcdHeader(FILE * file);
+
+void writePointCloud(FILE *f, Point *pointCloud, unsigned int Color);
+
+void markPointWithStar(FILE *file, Point point, unsigned int color);
+
+#define MAX_COLORS 18
+static unsigned int COLORS[] = {
+    0x00FFFF,
+    0xFF00FF,
+    0xFFFF00,
+    0xFF0000,
+    0x00FF00,
+    0x0000FF,
+    0x0080FF,
+    0x8000FF,
+    0x80FF00,
+    0x00FF80,
+    0xFF0080,
+    0xFF8000,
+    0x008080,
+    0x800080,
+    0x808000,
+    0x000080,
+    0x008000,
+    0x800000
+};
+#endif
+
+
-- 
cgit v1.2.3