diff options
author | Mike Turvey <mturvey6@gmail.com> | 2017-02-05 23:01:34 -0700 |
---|---|---|
committer | Michael Turvey <mturvey6@gmail.com> | 2017-02-05 23:57:51 -0700 |
commit | 7ea248577178f45033802ba5cc2867f8a66d69f8 (patch) | |
tree | 6bf3c7385d5aafc61e69a7d8dbe329bfeb52ec45 /tools/lighthousefind_tori/visualization.h | |
parent | 2afbb0313dafe3f52a38ee2061cb1de8043d16e6 (diff) | |
download | libsurvive-7ea248577178f45033802ba5cc2867f8a66d69f8.tar.gz libsurvive-7ea248577178f45033802ba5cc2867f8a66d69f8.tar.bz2 |
Adding lighthousefind_tori
Diffstat (limited to 'tools/lighthousefind_tori/visualization.h')
-rw-r--r-- | tools/lighthousefind_tori/visualization.h | 48 |
1 files changed, 48 insertions, 0 deletions
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 + + |