Rewrote the entire thing using my new OpenCL template. Makes small one offs like these reallly simple

include/util.hpp

@@ -0,0 +1,159 @@
+#pragma once
+#include <SFML/Graphics.hpp>
+#include <SFML/Graphics/VertexArray.hpp>
+#include "Vector4.hpp"
+#include <math.h>
+#include <bitset>
+#include <iostream>
+#include <fstream>
+#include <sstream>
+#include <string>
+#include <iterator>
+#include <list>
+#include <algorithm>
+
+
+const double PI = 3.141592653589793238463;
+const float  PI_F = 3.14159265358979f;
+
+inline sf::Vector3f SphereToCart(sf::Vector2f i) {
+
+	auto r = sf::Vector3f(
+		(1 * sin(i.y) * cos(i.x)),
+		(1 * sin(i.y) * sin(i.x)),
+		(1 * cos(i.y))
+		);
+	return r;
+};
+
+inline sf::Vector3f SphereToCart(sf::Vector3f i) {
+
+	auto r = sf::Vector3f(
+		(i.x * sin(i.z) * cos(i.y)),
+		(i.x * sin(i.z) * sin(i.y)),
+		(i.x * cos(i.z))
+		);
+	return r;
+};
+
+
+inline sf::Vector3f CartToSphere(sf::Vector3f in) {
+
+	auto r = sf::Vector3f(
+		sqrt(in.x * in.x + in.y * in.y + in.z * in.z),
+		atan(in.y / in.x),
+		atan(sqrt(in.x * in.x + in.y * in.y) / in.z)
+		);
+	return r;
+};
+
+inline sf::Vector2f CartToNormalizedSphere(sf::Vector3f in) {
+
+	auto r = sf::Vector2f(
+		atan2(sqrt(in.x * in.x + in.y * in.y), in.z),
+		atan2(in.y, in.x)
+		);
+
+	return r;
+}
+
+inline sf::Vector3f FixOrigin(sf::Vector3f base, sf::Vector3f head) {
+	return head - base;
+}
+
+inline sf::Vector3f Normalize(sf::Vector3f in) {
+
+	float multiplier = sqrt(in.x * in.x + in.y * in.y + in.z * in.z);
+	auto r = sf::Vector3f(
+		in.x / multiplier,
+		in.y / multiplier,
+		in.z / multiplier
+	);
+	return r;
+
+}
+
+inline float DotProduct(sf::Vector3f a, sf::Vector3f b){
+	return a.x * b.x + a.y * b.y + a.z * b.z;
+}
+
+inline float Magnitude(sf::Vector3f in){
+	return sqrt(in.x * in.x + in.y * in.y + in.z * in.z);
+}
+
+inline float AngleBetweenVectors(sf::Vector3f a, sf::Vector3f b){
+	return acos(DotProduct(a, b) / (Magnitude(a) * Magnitude(b)));
+}
+
+inline float DistanceBetweenPoints(sf::Vector3f a, sf::Vector3f b) {
+	return sqrt(DotProduct(a, b));
+}
+
+inline float DegreesToRadians(float in) {
+	return static_cast<float>(in * PI / 180.0f);
+}
+
+inline float RadiansToDegrees(float in) {
+	return static_cast<float>(in * 180.0f / PI);
+}
+
+inline std::string read_file(std::string file_name){
+	std::ifstream input_file(file_name);
+
+	if (!input_file.is_open()){
+		std::cout << file_name << " could not be opened" << std::endl;
+		return "";
+	}
+
+	std::stringstream buf;
+	buf << input_file.rdbuf();
+	input_file.close();
+	return buf.str();
+}
+
+inline void PrettyPrintUINT64(uint64_t i, std::stringstream* ss) {
+
+	*ss << "[" << std::bitset<15>(i) << "]";
+	*ss << "[" << std::bitset<1>(i >> 15) << "]";
+	*ss << "[" << std::bitset<8>(i >> 16) << "]";
+	*ss << "[" << std::bitset<8>(i >> 24) << "]";
+	*ss << "[" << std::bitset<32>(i >> 32) << "]";
+
+}
+
+inline void PrettyPrintUINT64(uint64_t i) {
+
+	std::cout << "[" << std::bitset<15>(i) << "]";
+	std::cout << "[" << std::bitset<1>(i >> 15) << "]";
+	std::cout << "[" << std::bitset<8>(i >> 16) << "]";
+	std::cout << "[" << std::bitset<8>(i >> 24) << "]";
+	std::cout << "[" << std::bitset<32>(i >> 32) << "]" << std::endl;
+
+}
+
+inline void DumpLog(std::stringstream* ss, std::string file_name) {
+
+	std::ofstream log_file;
+	log_file.open(file_name);
+
+	log_file << ss->str();
+
+	log_file.close();
+
+}
+
+#ifdef _MSC_VER
+#  include <intrin.h>
+#  define __builtin_popcount _mm_popcnt_u32
+#  define __builtin_popcountll _mm_popcnt_u64
+#endif
+
+inline int count_bits(int32_t v) {
+
+	return static_cast<int>(__builtin_popcount(v));
+}
+
+inline int count_bits(int64_t v) {
+
+	return static_cast<int>(__builtin_popcountll(v));
+}